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ABSTRACT 

This  thesis  shows  that  the  techniques  of  mode]  reference  con- 
touring and  extended  Kalman  filtering  are  valid  and  useful  for  iden- 
tifying parameters  in  ocean  vehicle  nonlinear  dynamic  mathematical 
models  using  noisy  input-output  data.   The  studies  begin  with  the 
development  of  general,  multiple  degree  of  freedom,  state  space, 
nonlinear  vector  differential  equation  mathematical  models  for  the 
overall  motion  of  ocean  vehicles  in  response  to  their  effectors. 
These  models  are  extended  to  include  fluidic  memory  effects  and 
higher  order  derivatives.   Next,  the  specific  equations  for  the  two 
identification  techniques  are  presented,  and  their  use  on  ocean 
vehicle  models  is  explained  in  great  detail.   Then  the  two  identi- 
fication techniques  are  applied  to  the  six*  single-degree-of-freedom 
equations  of  motion  for  the  Deep  Submergence  Rescue  Vehicle  (DSRV) 
for  a  large  number  of  different  types  of  input  functions  and  noise 
characteristic s.   After  presenting  the  detailed  equations  and  Fortran 
IV  subroutines  for  the  6  degree-of-freedom  DSRV  mathematical  model, 
several  selected  coefficients  are  identified  using  1,  2,  3i  ^i  5i  and 
6  degree-of-freedom  simulated  sea  trials  and  the  results  are  discussed 
and  compared.   Finally  a  complete  listing  is  provided  of  all  of  the 
identification  computer  programs  used,  and  a  bibliography  of  276 
references  from  the  areas  of  system  identification  and  ocean  vehicle 
dynamics  is  included. 

Thesis  Supervisor:  Martin  A.  Abkowitz 
Title:  Professor  of  Naval  Architecture 
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CHAPTER  T2 

CONVENTIONS  USED  IN  THIS  THESIS 

This  chapter  lists  in  a  somewhat  random  order  a  number  of 
explanations  of  the  symbols  and  language  to  be  used  throughout  this 
thesis  for  the  convenience  of  the  reader.   The  ideas  and  research 
presented  in  this  thesis  run  from  the  very  general  to  the  very 
specific. 
T2.1  SYMBOLS  USED 

x    dot  over  a  letter  means  its  time  derivative  d/dt 
x    underlined  letter  means  it  is  a  column  vector 
x    overlined  letter  refers  to  its  mean  value,  E  [x]  =  x 
x    letter  x  can  stand  for  x  as  a  variable,  a  function  x(t), 
or  a  number;  x  also  refers  to  forward  distance  traveled 
by  a  vehicle  (ft.) 
A    capital  letters  in  equations  represent  either  specific 

vehicle  coefficients  or  general  matrices 

T 
A    indicates  the  transpose  of  the  matrix  A 

A    indicates  the  inverse  of  the  matrix  A 

— T  T 

A    indicates  the  inverse  of  A 

e£x]  refers  to  the  mean  value  of  the  random  variable  x 

E    refers  to  the  error  covariance  matrix  used  in  Kalman  filtering 

u    vehicle  surge  (forward)  velocity  (feet/second)  relative  to  a 

coordinate  system  moving  with  the  vehicle;  u  =  x^  In  the 

general  state  vector  x 
u    vehicle  input  function  such  as  propellor  revolutions  per 

second;  u  is  used  as  an  input  variable  in  all  state  space* 
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equations  where  the  vehicle  surge  velocity  is  called  x-, . 
v   vehicle  sway  (sidewise)  velocity  (ft/sec);  v  =  x?  in  x 
v   measurement  noise  input  function  for  a  state  space  ocean 

vehicle  model,  4[v]  ^0;  vn  ■  v(tn)  for  discrete  samples 
w   vehicle  heave  (vertical)  velocity  (ft/sec);  w  =  x-^  in  x 
w   process  noise  or  input  noise  to  the  vehicle  for  a  state  space 

ocean  vehicle  model,  E[~w  1  =  0;  w  =  w(t  )  for  discrete  samples 
p   vehicle  roll  velocity  (radjans/sec) ;  p  =  x^  in  x 
p   general  equation  parameter  in  the  state  space  mathematical 

model  of  an  ocean  vehicle 
q   vehicle  pitch  velocity  (radians/second) ;  q  =  x,  in  x 
q   error  covariance  of  the  discrete  process  noise  w 
r   vehicle  yaw  velocity  (radians/second) |  r  =  x/  in  x 
r   error  covariance  of  the  discrete  measurement  noise  v 
x   general  ocean  vehicle  state  vector  which  may  or  may  not 

have  the  vehicle  parameters  included  within  it 
u   general  ocean  vehicle  input  vector  for  state  space  models 
v   measurement  noise  input  vector  for  state  space  models; 

E[v(t)  vT(t+r)]  r=  Rc  s(t)   ;   R  a  Rc/6t  for  discrete  noise  ■ 
w   vehicle  input  noise  vector  for  state  space  models; 

E[w(t)  £_T(t+r)]  m  q     5(r)   ;   Q  «  Q  6t  for  discrete  noise 
6(f)  Dirac  delta  function   ;   (B-7,  pages  330-333) 
R   discrete  measurement  noise  error  covariance;  used  in 

simulations 
Q   discrete  process  or  input  noise  error  covariance;  used  in 

simulations 
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£    vehicle  parameter  or  coefficient  vector;  pay  be  included  or 
augmented  into  x;  3.11  coefficients  are  parameters,  but  some 
vehicle  parameters  are  not  considered  to  be  coefficients 
z    vehicle  output  vector  for  state  space  models 
t    time,  seconds 

f    system  structure  vector  in  state  space  models 
h    measurement  structure  vector  in  state  space  models 
£    parameter  structure  vector  in  state  space  models 
(x,y,z,0f9,"V)   ocean  vehicle  linear  and  angular  coordinates 

or  distances  in  feet  or  radians 
(X,Y,Z,KfM,N)   ocean  vehicle  forces  and  moments  (sometimes 

called  simply  forces) 
(u,v,w,p,q,r)   ocean  vehicle  six  degrees  of  freedom  in  linear" 

and  angular  velocities;  see  Figure  T2.1 

T 
I    moment  of  inertia  vector  or  matrix,  I  ~  (i   I   i)= 
—x  — X    x  xx  yy   zz 

i=l,6  comma  designates  intermediate  values,  i  =  1,2,3»^i5i6 
i,j=l,6  means  i  =  1,6  and  j  =  1,6 

I    the  identifiability  of  a  parameter  or  coefficient 

M    the  modelability  of  an  ocean  vehicle 

T 
X    vehicle  forces  and  moments,  X  =  (X  Y  Z  K  M  N) 

CeG.  center  of  gravity,  Xq  =  (xG  yQ  z^)     =  (x,G  x^Q     x„Q) 

T  T 

C.B.  Center  of  buoyancy,  x     ■  (xfi  yB  z-g)  ■  (x1B  x^B     x^fi) 


m 


mass  of  the  ocean  vehicle  (slugs) 


X.  .  vector  of  the  ij'th  force  and  moment  second  degree 

coefficients;  these  coefficients  correspond  to  those 

used  in  the  literature  (A-l)  (S-9) 

C    Scalar  cost  functional,  C  >  0 
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e    measurement  error 

x    estimated  value  of  the  variable  x 

x*   next  time  increment  estimate  of  the  variable  x 

6t   time  increment 

D    dependent  functions  in  the  identifiability  functional  l(D) 

S    system  structure;  structure  in  this  thesis  always  refers 

to  mathematical  equation  structure  and  never  to  the 

physical  structure  of  a  vehicle 
K    Kalman  filter  gain  matrix 

p_*   the  optimum  or  best  value  of  the  parameter  vector  p_ 
O         standard  deviation  of  a  gaussian  random  variable 
£    symbol  meaning  "is  an  element  of" 
{    J  J  braces  defining  a  set  of  numbers 
N(a,b) normally  distributed  or  gaussian  random  variable  of  mean 

a  and  variance  b;  if  a  =  0,  os  =  b  in  this  notation;  also 

written  a  +  o 
•y        equation  time  constant  (seconds) 
R    in  a  table  indicates  a  relative  minimum  as  opposed  to  an 

absolute  minimum 

0    angular  frequency  of  a  sine  wave,  9  -  2rr/period 

X     gravity  forces  and  moments  for  an  ocean  vehicle 
— grav  ^    J 

X      secondary  drag  forces  and  moments  for  the  DSRV,  Appendix  A3 

■"'SCC 

X     constant  forces  and  moments  for  an  ocean  vehicle 
-cons 

X,.    disturbance  (noise)  forces  and  moments  for  an  ocean  vehicle 
-dist 

x'   untransformed  DSRV  accelerations 

X,  .  the  k'th  second  degree  coefficient  in  X. 
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(k,i, j)  the  location  of  X. .  in  a  storage  vector  for  computation 
F    gradient  matrix  of  an  ocean  vehicle,  F  =  d'^/dz. 
a+cf  mean  +  standard  deviation  of  a  gaussian  random  variable, 
N  (a,  cj2) 
T2.2  LANGUAGE  USED 

parameters     general  variables  in  the  mathematical  model 

equations;  may  be  states,  constants,  or  time 

variables 
coefficients   ocean  vehicle  parameters  which  result  from  the 

Taylor  series  expansion  of  the  hydrodynamic 

forces  and  moments 
noise         random  variable,  stochastic  process,  unknown  or 

uncertain  input 
and  A  and  B  means  both  A  and  B 

or  A  or  B  means  either  A  or  B  or  both  A  and  B; 

inclusive  or 
either* «»or    A  or  B  but  not  both;  exclusive  or 
neither* •• nor  means  not  A  and  not  B 

dynamics      the  six  primary  velocities  of  an  ocean  vehicle; 

T 
(u  v  w  p  q  r)  t  unless  otherwise  stated 

motion 
behavior 

overall  motion  "         M         " 

order         the  highest  derivative  in  a  differential  equation 
degree        the  power  of  the  highest  derivative  in  a  differen- 
tial equation  or  the  power  to  which  a  term  is 
raised  in  a  polynomial 


degree  of  freedom  one  of  the  six  primary  velocities  of  an 

ocean  vehicle 
Chapter  P3.2      refers  to  subsection  P3.2  of  Chapter  P3 
EKF  extended  Kalman  filter 

DSRV  Deep  Submergence  Rescue  Vehicle,  Figure  T2.1 


-15- 


pq 


o 

•H 
+> 
U 

> 

o 


5 

o 
o 


H 

0)1 

cd 

iH 

-p 

,0 

c 

ctf 

o 

•H 

•H 

£* 

fc 

> 

O 

W 

h 

ij 

*« 

a 

as 


*  o 


Pi 


^-^ 

H 

CJ 

1 

H 

i< 

O 

•H 

-C 

f. 

Q) 

CD 

> 

+» 

CO 

c 

£». 

nj 

CO 

0) 

o 

0) 

o 

-p 

«J 

H 

c 

ed 

•H 

M 

'd 

(U 

h 

c 

o 

CI.) 

o 

o 

o 

pq 


•  rH  -P 
-P  «H 

<H  On 

cor^n+s 

co  -=r  iH 
-3"  H     .00 

li     .1     I     tt 


H 

0) 

-p 

o 

e. 

^~N 

<d 

a 

Cj    »H 

Fh   3 

H 

0)     CT1 

id 

>    H 

o 

O^ — 

•H 

x:  +> 

4 

tobO 

•H 

C  -H 

OrH 

0)    0) 

eq>> 

t-H*     S= 

to  o 

C-l 
CO 

>H 

CO 

Eh 
< 
^; 

HI 
Q 

O 

o 
o 


< 

> 

« 

CO 
R 

H 

£h 


o 
h 


CHAPTER  T3 

LIST  OF  TABLES  PAGE 

M2.1  Numbers  of  Coefficients  Through  Third  Degree,.........,...,  60 

N4.1   Selected  Reduced  Degree  of  Freedom  Models  for  the  DSRV.,,..  141 

P2.1  Characteristics  of  DSRV  Single  Degree  of  Freedom  Models....  156 

P3.1  Surge  Equation  Identif lability  Characteristics  for  a 

Step  Input,  .......................... 174 

P3.2  Surge  Equation  Identifiability  Characteristics  for  a 

Staircase  Input , , , , , , ,  130 

P3.3  Surge  Equation  Identifiability  Characteristics  for  a 

Crashback  Full  Astern  Input .......<.,................  183 

P3.4  Surge  Equation  Identifiability  Characteristics  for  a 

Simulated  Impulse  Input, , 187 

P3«5  Noise  Behavior  Characteristics  for  a  100  Second-Period 

Sinusoidal  Input.  ••••••«..,. •..••*. «...., •  197 

P3#6  Noise  Behavior  Chatacteristics  for  a  150  Second-Period 

Sinusoidal  Input, ...,,., , , ••••••  199 

P3.7  Noise  Behavior  Characteristics  for  a  300  Second-Period 

Sinusoidal  Input, ........................ 19? 

P3.8  Noise  Behavior  Characteristics  for  a  500  Second-Period 

Sinusoidal  Input. . . . , 198 

P3.9  Noise  Behavior  of  a  Linear  Model  for  the  Nonlinear 

Surge  Equation. 200 

P4.1  EKF,  Staircase,  l%v,   l%w,   xQ«l  +  0.7,  Q=Qn,  R=Rn 227 

P4.2  EKF,  Staircase,  l%v,   l#w,  xQ=l  +  0.7,  Q=5Qn,  R=5Rn 227 

P4.3  EKF,  Staircase,  l%v,   l#w,  xQ=l  +0.7,  0-100^,  R=50R  ., 228 

P4.4  EKF,  Staircase,  l%v,   l%w,   xo=l  +0.7,  Q-Qn,  R=10Rn... 229 

P4.5  EKF,  Step,  1%   and  10$  Noises,  Q-Qn,  R=10Rn .,  231 

P4.6  EKF,  Staircase,  Noise  Combinations,  0=0^,  R=10Rn 233 


P4.7  EKF,  Crashback  Full  Astern,  1%   and  10?S  Noises,  Q-Qn, 

-17- 


R=10Rn . a . .  23^ 


LIST  OF  TABLES  (Contd. )  PAGE 

P4.8  EKF,  Simulated  Impulse,  1%   and  10^  Noises,  0-0^  R=10R  . . . .  235 

P4.9  EKF,  Sinusoidal,  100  Second  Period,  1%   and  3.0^  Noises 

^=Qn,  R=10Rn , .  0 238 

P4.10  EKF,  Sinusoidal,  150  Second  Period,  0=^,  R=10R  . , ...  237 

P4.ll  EKF,  Sinusoidal,  300  Second  Period,  1%   and  10^  Noises, 

0=0^  R=10Rn 238 

P4.12  EKF,  Sinusoidal,  500  Second  Period,  1%   and  10#  Noises, 

0=^,  R-10Rn 239 

P4.13  EKF,  Staircase,  H=4,  %v ,   2%vt,   Runge-Kutta,  Different 

Initial  Conditions  .••••••..•.« ........... 240 

P4.14  EKF,  Staircase,  Runge-Kutta,  Large  Noises...*. 241 

P4.15  EKF  Identifications  for  the  Six  DSRV  Single  Degree  of 

Freedom  Models. 251 

C2.1  Contour  Values  for  Xuu  and  P(229),  3  through  6  D0F  Models..  340 

C2.2  DSRV  Parameters  Identified  Using  3  D0F;  No  Noise 346 

A13.1  Tables  and  Figures  for  Linear  Model  Reference  Studies. 481 

A13«2  Noise  Characteristics,  Linear  System,  Step  Input,.,.....,,,  481 

A13.3  Noise  Characteristics,  Linear  System,  Staircase  Input,,.,,,  482 

A13.4  Noise  Characteristics,  Linear  System,  Simulated 

Impulse  Input , , 483 

A13.5  Noise  Characteristics,  Linear  System,  Sinusoidal 

150  Input. 483 

A13.6  Noise  Characteristics,  Linear  System,  Nonlinear 

Model ,  Sinusoidal  150  Input. 484 


-18- 


CHAPTER  Tk 

LIST  OF  ILLUSTRATIONS  PAGE 

T2.1  The  DSRV  and  a  General  Coordinate  System 16 

II,  1  Section  Relationship  Diagrams, ,  28 

13.  I   ttimmt  Svsre*,  aho   Trres    «»=  C««r*««.t  Em 3  6 

M2.1  Block  Diagram  of  a  Dynamic  System, , 55 

M3, 1  Absolute  Square  Law  Drag. ,  ?6 

M^-.l  System  Diagram  of  a  General  Ocean  Vehicle  Mathematical 

Model  with  Noise  Inputs, 83 

Nl.l  The  General  Parametric  Identification  Problem. ..,,.  88 

N1.2  Parametric  Stochastic  Dynamic  System  Block  Diagram 89 

N1.3  The  Ocean  Vehicle  Parametric  Identification  Problem,,. 91 

N2.1  Model  Reference  Configuration ...,., , 9^ 

N2, 2  Model  Reference  Identification  System. 97 

N2. 3  Example  Single  Parameter  Cost  Function  Curve, .,.,.,. 100 

N2.4  Example  Dual  Parameter  Cost  Function  Contours,,,,,,,..,....  103 

N3. 1  A  General  State  Estimation  Probl  em 106 

N3. 2  The  Ocean  Vehicle  State  Estimation  Problem. ,  10? 

N3. 3  Extended  Kalman  Filtering  System, ...............  c H? 

N^-.l  Flowchart  for  Modeling  and  Identification... 124 

N4. 2  An  Absolute  Linear  Cost  Function, .,.,,.,,.... 129 

N4.3  Most  Identifiable  C(p_)  for  Model  Reference  Contouring, .... «  130 

N4.4  Typical  Model  Reference  Contour  Configurations •••••••  131 

N4. 5  Typical  Output  Plots  from  a  Kalman  Filter. .................  13** 

Pl.l  Example  Sea  Trial  Blocks  for  DSRV..., 1^9 

P3.1  DSRV  Surge  Equation  and  Parameter  Values. 163 

P3.2  Propellor  Step  Function  Input 164 


-19- 


LIST  OF  ILLUSTRATIONS  (Contd. )  PAGE 


P3.3  Plot  of  D3HV  Surge  Velocity  for  a  Step  Function 

Input  and  No  Noise, . , . , 16 


P3.^  DSRV  Surge  Velocity  for  Step  Function  Input, 

10/6v,  and  10'fovt   Noises. 166 

P3#  5  Numerical  Values  of  Contour's  in  Figure  P3.6 167 

P3.6  Surge,  No  Noise,  Step  Function  Contours 168 

P3.7  Plot  of  5  Left  to  Right  Vertical  Slices  of  Figure  P3.6 171 

P3.8  Numerical  Values  of  Contours  in  Figure  P3.9. 172 

P3.9  Surge,  1Ct£w,  10;£v,  Step  Function  Contours.... 173 

P3. 10  Propellor  Staircase  Function  Input, 175 

P3.ll  Surge  Velocity,  Staircase  Input,  Mo  Noise.,,,, 176 

P3. 12  Numerical  Values  of  Contours  in  Figure  P3. 13 175 

P3.13  Surge,  No  Noise,  Staircase  Function  Contours. 177 

P3. 1^  Crashback  Full  Astern  Input  Function. ].8l 

P3.15  Surge  Velocity,  Crashback  Full  Astern  Input,  No  Noise.,,.. .  182 

P3.16  Numerical  Values  of  Contours  in  Figure  P3.17.... «...  183 

P3.17  Surge,  No  Noise,  Crashback  Full  Astern  Contours. 18^ 

P3.18  Simulated  Impulse  Input  Function. 185 

P3.19  Surge  Velocity,  Simulated  Impulse  Input,  No  Noise,,,.......  186 

P3. 20  Numerical  Values  for  Figure  P3. 21 , 187 

P3.21  Surge,  No  Noise,'  Simulated  Impulse  Function  Contours,,,..,.  188 

P3.22  Surge  Velocity,  Sinusoidal  Input,  Period  150 

Seconds ,  No  Noise, .,.....<•..,,,....,,.,,..............,..,  190 

P3. 23  Numerical  Values  for  Figure  P3. 25. 191 

P3.2^  Surge,  No  Noise,  100  Second  Sinusoidal  Input 

Function  Contours 192 

P3.25  Surge,  No  Noise,  150  Second  Sinusoidal  Input 

Function  Contours. c . .  193 

-20- 


LIST  OF  ILLUSTRATIONS  (Contd. )  PACK 

P3.26  Surge,  No  Noise,  300  Second  Sinusoidal  Input 

Function  Contours , 194 

P3.27  Surge,  No  Noise,  500  Second  Sinusoidal  Input 

Function  Contours , 195 

P3.28  No  Noise,  Sinusoidal  Input,  150  Second-Period, 

Nonlinear  Equation,  Linear  Model  Contours.,, 201 

P4.1  Plot  of  Staircase  Input  Function  and  DSRV  Surge 

For  l%v   and  l%w   Noises ...... 205 

P4.2  Kalman  Filter  Surge  Velocity  for  Figure  P4.1,  1st  Pass 209 

P4.3  Identification  of  Pn(-l6.7)  For  Figure  P4.1,  1st  Pass 210 

P4.4  Identification  of  P2(755)  For  Figure  P4.1,  1st  Pass........  211 

Pty. 5  Surge  Velocity  Standard  Deviation  for  Figure  P4.1, 

1st  Pass. 212 

P4.6  Parameter  p-.  Standard  Deviation  For  Figure  P4.1, 

1st  Pass 213 

P4.7  Parameter  p  Standard  Deviation  For  Figure  P4.1, 

1st  Pass... 7 ......... 214 

P4.8  Kalman  Filter  Surge  Velocity  for  Figure  P4.1,  2nd  Pass 215 

P4.9  Identification  of  p  (-16.7)  For  Figure  P4.1,  2nd  Pass 216 

P4.10  Identification  of  P2(755)  For  Figure  P4.1,  2nd  Pass........  217 

P4.ll  Surge  Velocity  Standard  Deviation  For  Figure  P4.1, 

2nd  Pass. 218 

P4.12  Parameter  p  Standard  Deviation  For  Figure  P4.1, 

2nd  Pass....... 219 

P4.13  Parameter  p  Standard  Deviation  For  Figure  P4.1, 

2nd  Pass, ,....,.,.. 220 

P4.14  Kalman  Filter  Surge  Velocity  For  Figure  P4.1,  3rd  Pass,....  221 

P4.15  Identification  of  p1(-l6.7)  For  Figure  P4.1,  3rd  Pass. . . . . .  222 

P4.16  Identification  of  P2(755)  For  Figure  P4.1,  3rd  Pass 223 

-21- 


LIST  OF  ILLUSTRATIONS  (Contd. )  PAGE 

P4.17  Surge  Velocity  Standard  Deviation  For  Figure  P4.1, 

3rd  Pass. « 224 

P4.18  Parameter  p  Standard  Deviation  For  Figure  P4.1, 

3rd  Pass. .  .7 . 225 

P4.19  Parameter  p  Standard  Deviation  For  Figure  P4.1, 

3rd  Pass. 226 

P4.20  Surge  Sea  Trial  Data,  25^  v  and  w  Noises, 

Staircase  Input. ...««..  t .............. « 242 

P4.21  EKF  Surge  Velocity  Estimates  For  Figure  P4.20  Data 2*4-3 

P4.22  EKF  Parameter  p  Identification  For  Figure  P4.20  Data 244 

P4.23  EKF  Parameter  p2  Identification  For  Figure  P4.20  Data......  245 

P4.24  Surge  Sea  Trial  Data,  75$>  v  and  w  Noises, 

Staircase  Input. ..**.........<.•.<... 246 

P4.25  EKF  Surge  Velocity  Estimates  For  Figure  P4.24  Data 247 

P4.26  EKF  Parameter  p  Identification  For  Figure  P4.24  Data 248 

P4.27  EKF  Parameter  p  Identification  For  Figure  F4.24  Data......  249 

D2. 1  Abbreviated  Flowchart  for  Subrouti ne  OVMOD 266 

Cl.l  Simulated  Ramp  Input  for  the  DSRV  Propellor. . . , 300 

CI. 2  DSRV  Surge  Velocity,  1  DOF,  Simulated  Ramp  Input. 301 

CI. 3  DSRV  Roll  Rate,  1  DOF,  Simulated  Ramp  Input 303 

CI. 4  DSRV  Angles  (Radians),  2  DOF,  Simulated  Ramp  Input 304 

CI. 5  DSRV  Heave  Velocity  for  3  DOF  (ft/sec) 305 

CI. 6  DSRV  Pitch  Velocity  for  3  DOF  (rad/sec). 306 

CI. 7  DSRV  Angles  for  3  DOF  (Radians)...... 307 

CI. 8  DSRV  Heave  Velocity  for  4  DOF  (ft/sec) ,.  309 

CI. 9  DSRV  Angles  for  4  DOF  (Radians) 310 

CI. 10  DSRV  Pitch  Velocity  for  5  DOF  (rad/sec).. 311 

-22- 


LIST  OF  ILLUSTRATIONS  (Contd.)  PAGE 

CI, 11  DSRV  Yaw  Velocity  for  5  DOF  (rad/soc) , 312 

CI. 12  DSRV  Angles  for  5  DOF  (radians). . , 313 

CI. 13  DSRV  Surge  Velocity  for  6  DOF  (ft/sec) 315 

CI. 14  DSRV  Sway  Velocity  for  6  DOF  (ft/sec),., . 316 

CI. 15  DSRV  Heave  Velocity  for  6  DOF  (ft/sec) 317 

CI. 16  DSRV  Roll  Velocity  for  6  DOF  (rad/scc) 318 

CI. 17  DSRV  Pitch  Velocity  for  6  DOF  (rad/sec) 319 

CI. 18  DSRV  Yaw  Velocity  for  6  DOF  (rad/sec).. 320 

CI. 19  DSRV  Angles  for  6  DOF  (radians) .. ...  321 

CI  •  SO    Sanpu    fi»S7/.»/   of  Block    Pejc«ipr/o«   FR«»   P******   H*in 3^3 

C2.1  Xuuand  P(229)  Contours,  6  DOF,  Simulated  Ramp  Input, 334 

C2.2  Five  Vertical  Slices  of  Figure  C2.1  (Left  to  Right) 335 

C2.3  Five  Horizontal  Slices  of  Figure  C2.1  (Top  to  Bottom)......  336 

C2.4  Logarithmic  Contours  of  Figure  C2.1, .......... , 337 

C2.5  Five  Vertical  Slices  of  Figure  C2.4.. 338 

C2. 6  Five  Horizontal  Slices  of  Figure  C2, 4 ,  339 

C2.7  X^u  and  X»  Contours,  6  DOF,  Simulated  Ramp  Input. .,  342 

C2.8  X   and  P(230)  Contours,  4  DOF,  Simulated  Ramp  Input 344 

C2.9  X   and  P(23l)  Contours,  4  DOF,  Simulated  Ramp  Input 345 

A13.1  Linear  System,  No  Noise,  Step  Function  Contours 485 

A13.2  Linear  Systenij  No  Noise,  Staircase  Function  Contours.......  486 

A13«3  Linear  System,  No  Noise,  Simulated  Impulse  Function 

Contours 487 

A13.4  Linear  System,  No  Noise,  Sinusoidal  150  Second 

Input  Contours, , .<....,..........•«.....  488 

A13.5  Linear  System,  Nonlinear  Model,  Sinusoidal  150, 

No  Noise  Contours. .*•••••••.,.. 489 


-23- 


SECTION  1 

INTRODUCTION  (i) 

11  GENERAL  ORIENTATION  TO  THE  PROBLEM  AREA 

12  THESIS  PROBLEM  DESCRIPTION 

13  THE  OCEAN  VEHICLE  AS  A  BLACK  BOX 

14  SYSTEM  IDENTIFICATION 

15  PRIMARY  CONTRIBUTIONS  OF  THIS  THESIS 


"I  DO  NOT  UNDERSTAND;  I  PAUSE;  I  EXAMINE."  -  MICHEL  DE  MONTAIGNE 

(1533-1592)  ■ 


THE  PURPOSE  OF  THIS  SECTION  IS  TO  PROVIDE  THE  READER  WITH  A  GENERAL 
PERSPECTIVE  FROM  WHICH  TO  VIEW  THE  STUDIES  AND  RESULTS  OF  THIS 
THESIS.   A  VERY  GENERAL  DISCUSSION  OF  THE  CENTRAL  ISSUES  INVESTI- 
GATED IS  PROVIDED,  AND  A  BRIEF  SUMMARY  OF  SOME  OF  THE  RESULTS  AND 
CONTRIBUTIONS  IS  GIVEN.   THIS  SECTION  ANSWERS  THE  FOLLOWING 
QUESTIONS: 

WHAT  IS  THE  PROBLEM? 

HOW  IS  IT  SOLVED? 

HOW  IS  ITS  SOLUTION  USEFUL? 

WHY  IS  ITS  SOLUTION  NECESSARY? 

WHAT  MAKES  IT  DIFFICULT  TO  SOLVE? 

HOW  DOES  THE  SOLUTION  RELATE  TO  THE  REAL  WORLD? 

THE  NEXT  SECTION  BEGINS  THE  ACTUAL  THESIS  STUDIES  BY  DEVELOPING 

STATE  SPACE  MATHEMATICAL  MODELS  FOR  THE  DYNAMIC  MOTIONS  OF1  OCEAN 

VEHICLES c 
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CHAFfER  II 

GENERAL  ORI POTATION  TO  THE  PROBLEM  AREA 

The  studies  and  results  presented  in  this  thesis  apply  to  the 
general  areas  of  motion  control  and  design  of  ocean  vehicles.   Both 
the  motion  control  and  the  design  of  such  vehicles  are  greatly- 
facilitated  by  the  capability  of  quantitatively  predicting  the  dynamic 
behavior  of  the  vehicle  under  the  influence  of  its  effectors.  One 
way  of  developing  this  predictive  capability  is  through  the  use  of 
mathematical  models  and  computer  simulations  which,  in  essence,  run 
a  mathematical  version  of  the  vehicle  in  the  computer  rather  than 
running  the  actual  vehicle  in  water.  The  computerized  version  of 
the  vehicle  allows  cheaper,  faster,  and  more  flexible  studies  to  be 
made  of  its  motion  characteristics  than  can  be  made  with  the  full- 
scale  vehicle  or  a  physical  model  of  it.  However,  it  is  important 
that  the  mathematical  model  behavior  accurately  represent  the  real 
vehicle  behavior  in  order  for  the  computer  simulations  to  be  useful 
in  control  or  design  of  the  real  vehicle, 

The  studies  in  this  thesis  apply  to  the  specific  problem  of 
determining  accurate  mathematical  models  for  vehicle  motion  behavior. 
Such  models  are  determined  here  by  applying  the  techniques  of  para- 
metric identification,  from  Modern  Control  Theory,  to  noisy  input- 
output  data  from  simulated  vehicle  maneuvers  and  to  mathematical 
model  differential  equation  structure,  from  Hydrodynamics,  in  order 
to  evaluate  the  undetermined  portions  of  the  model.   These  techniques 
may  be  used  both  to  evaluate  the  model  parameters  and  to  provide 
quantitative  and  qualitative  measures  of  the  mathematical  model 
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accuracy  using  those  parameters. 

The  mathematical  model,  once  determined,  may  be  used  by  the 
vehicle  designer  or  by  the  vehicle  control  system.  Such  a  model 
would  be  useful  in  the  design  process  because  design  changes  could 
be  reilected  directly  in  terms  of  the  resulting  vehicle  motion 
characteristics  changes.   The  model  would  be  useful  in  the  vehicle 
control  system,  within  the  vehicle  during  operation  or  outside  of 
the  vehicle  during  the  design  process,  because  its  predictive  capabil- 
ities would  permit  the  control  system  to  select  the  best  vehicle 
effector  inputs  to  carry  out  a  specified  maneuver. 

There  are  many  uncertainties  involved  in  the  process  of  develop- 
ing mathematical  models  of  vehicle  behavior.   Whenever  vehicle 
inputs  or  outputs  are  measured  by  a  data  acquisition  system,  there  is 
always  some  amount  of  noise  present;  and  whenever  the  mathematical 
model  structure  is  developed,  there  is  uncertainty  as  to  whether  or 
not  it  will  accurately  represent  the  real  vehicle.  The  parametric 
identification  techniques  used  in  this  thesis  are  designed  to  operate 
on  noisy  input-output  data  and  to  give  a  "best"  or  "optimum"  set  of 
parameters  in  spite  of  the  noise.   Therefore,  the  identification 
methods  applied  in  this  thesis  will  facilitate  both  the  design  and 
the  control  of  a  vehicle  in  a  noisy  environment. 

In  the  studies  of  this  thesis  a  mathematically  simulated  ocean 

vehicle  (specifically  the  DSRV,  Deep  Submergence  Rescue  Vehicle)  with 

a  fixed  and  known  set  of  parameters  is  used  tc  generate  noisy  vehicle 

input -out put  data.  The  same  model  structure,  but  with  different  or 

unknown  parameters,  is  then  used  in  the  identification  procedures  in 
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attempts  to  redetermine  the  original  or  "true"  set  of  parameters  used 
in  the  data  generation,..   The  techniques  are  developed  and  utilized 
in  such  a  way  tha.t  not  only  are  the  parameters  determined  (identified) 
but  they  are  also  studied  for  the  characteristics  of  ease  and  accuracy 
with  which  they  may  be  determined  (identifiability). 

This  combination  of  identifications  and  identifiability  studies 
of  vehicle  parameters  provides  a  "bridge"  from  the  simulated  vehicle 
to  the  real  vehicle.   If  the  "true"  parameters  are  found  again  from 
noisy  simulation  data,  if  the  real  vehicle  mathematical  model 
differential  equation  structure  is  the  same  ?.s  that  of  the  simulated 
vehicle,  and  if  the  parameters  in  the  simulated  vehicle  are  identifi- 
able  from  the  generated  data,  then  the  parameters  found  from  noisy 
real  vehicle  data  should  be  the  "true"  parameters  for  the  real  vehicle. 
The  word  "should"  is  the  best  that  can  be  used  in  this  logic  chain 
because  of  the  model  and  measurement  uncertainties,  because  of  the 
highly  nonlinear  nature  of  most  ocean  vehicle  mathematical  model 
structure,  and  because  the  proper  inputs  (sometimes  unknown)  must  be 
used  in  many  cases  in  order  that  the  parameters  be  identifiable. 

The  specific  layout  of  this  thesis  proceeds  as  follows  (in  brief) : 

Section  2(m)  present  the  mathematical  model  equations, 

Section  3(N)  present  the  equations  for  the  identification  techniques, 

Section  MP)  combine  these  equations  for  in-depth  studies  of  simple 
models, 

Section  5(d)  present  the  DSRV  6  degree  of  freedom  model, 

Section  6(C)  present  selected  parameter  studies  of  the  large  DSRV 
model. 

A  diagramatic  dependence  chain  of  these  thesis  sections  is  shown  in 

Figure  11,1  in  both  number  and  mnemonic  letter  form,   The  general 

layout  of  the  thesis  is  intended  to  run  from  very  general  ideas  in 
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the  beginning  sections  to  very  specific  ideas  and  evaluations  in  the 
later  sections.   The  sections  have  been  designed  as  completely 
independent  blocks  of  ideas  with  interconnections  being  made  through 
equation,  figure,  and  chapter  (subsection)  references. 

This  chapter  has  presented  a  very  brief  introduction  to  the 
topics  to  be  covered  in  this  thesis  and  the  order  and  structure  in 
which  these  topics  are  to  be  discussed.   The  studies  and  results  in 
this  thesis  apply  to  the  general  area  of  mathematically  simulating 
the  overall  motion  of  ocean  vehicles.   The  ultimate  aims  of  mathemati- 
cal simulation  are  to  be  able  to  quantitatively  predict  the  vehicle 
dynamic  behavior  and  to  understand  the  specific  features  of  the 
vehicle  which  cause  it  to  behave  as  it  does.   This  information 
shows  the  vehicle  designer  the  results  of  his  proposed  vehicle 
directly  referenced  to  its  motion  and  allows  the  control  system 
designer  to  use  predictive  control  methods.   The  next  chapter  presents 


a  somewhat  more  detailed  discussion  of  the  parametric  identification 
problem  as  it  applies  to  this  thesis. 
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CHAPTER  12 

THESIS  PROBLEM  DESCRIPTION 

The  problem  is  to  identify  certain  basic  parameters  in  a  mathe- 
matical model  which  simulates  the  dynamics  of  an  ocean  vehicle.   To 
identify  parameters  means  to  determine  their  numerical  values  with 
sufficient  accuracy  to  satisfy  a  stated  criterion.   The  vehicle  model 
to  be  used  is  a  system  of  nonlinear  first-order  differential  equations 
with  some  undetermined  parameters  or  coefficients. 

The  ocean  vehicle  mathematical  model,  hereafter  called  the  model, 
along  with  its  set  of  identified  parameters  is  designed  to  directly 
relate  to  a  mathematically  simulated  vehicle.  The  simulated  ocean 
vehicle,  hereafter  called  the  system,  is  designed  to  closely  resemble 
a  real  ocean  vehicle,  A  measure  of  closeness  is  chosen  to  specify 
the  relationship  between  the  model  and  the  system,  and  the  term 
"optimal"  or  "best"  specifies  the  desired  accuracy  of  the  parameters. 

The  computer  simulation  of  the  vehicle  then  consists  of  solving 
the  model  differential  equations  for  a.  .given  set  of  effector  ( propel - 
lor,  rudder,  etc.)  inputs  and  taking  input-output  data  measurements 
from  the  vehicle  motions  or  maneuvers  which  result  from  those  inputs. 
The  uncertainties  in  the  model  structure,  the  inputs,  and  the  measure- 
ments are  simulated  by  adding  noise,  generated  by  the  computer,  to 
the  model  equations  and  to  the  measured  data.   The  parameters  used 
in  the  simulation  are  a  fixed  and  known  set  of  numbers. 

This  noisy  data  produced  by  the  simulation  is  then  used  to 
identify  the  parameters  in  the  mathematical  model  assuming  that  they 
are  not  known  originally.   The  "best"  set  of  parameters  is  determined 
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to  be  those  which  give  the  minimum  closeness  between  the  simulated 
vehicle  and  the  mathematical  model.  This  process  of  using  the  vehicle 
input-output  data,  mathematical  model  structure,  and  measure  of 
closeness  to  determine  the  parameters  in  the  model  is  called  para- 
metric identification. 

Studies  in  parametric  identification  for  a  particular  ocean 
vehicle  must  first  begin  with  either  the  assumption  or  the  determina- 
tion that  the  parameters  are,  indeed,  identifiable.   For  given  input- 
output  data,  structure,  and  measure  of  closeness,  the  desired 
parameters  may  not  be  identifiable,  and  the  assumption  that  they  exe 
identifiable  will  not  be  shown  fallacious  by  the  failure  of  a  given 
procedure  to  find  them,   Identifiability  studies  are  best  made  by 
using  a  fixed  structure  and  measure  of  closeness  and  then  varying 
the  input-output  data  in  the  identification  proceduree 

It  is  in  many  cases  both  easier  and  less  costly,  for  the  purpose 
of  studying  identification  techniques,  to  make  these  input-output 
data  variations  on  a  mathematically  simulated  ocean  vehicle  than  on 
a  physical  model  or  full-scale  vehicle  because  of  the  current  cap- 
abilities of  digital  computers.   For  this  reason  it  is  desirable  to 
use  a  simulated  vehicle  to  study  identifiability  and  to  determine 
the  type  of  data  required  for  identification.   The  data  from  the 
physical  model  or  full-scale  vehicle  can  then  later  be  used  to 
identify  parameters  in  the  mathematical  model. 

In  this  thesis  the  Deep  Submergence  Rescue  Vehicle  (DSRV)  is  the 
particular  vehicle  studied  for  the  purpose  of  identifying  the  param- 
eters in  its  mathematical  model.   These  parameters  are  first  examined 

to  determine  their  identifiability  characteristics,  and  then  they  are 
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actually  identified  using  several  different  kinds  of  input  functions. 
Two  identification  techniques,  model  reference  contouring  and 
extended  Kalman  Filtering,  are  utilized  to  identify  the  parameters 
and  to  determine  their  capabilities  for  identification,  A  given  set 
of  DSRV  parameters  is  used  to  simulate  the  real  DSRV  and  to  generate 
purposely  noisy  input-output  data.  Using  this  input-output  data, 
studies  are  then  made  to  identify  the  given  set  of  DSRY  parameters 
assuming  that  they  are  unknown  or  inaccurately  known. 

Identification  of  the  DSRV  parameters  by  the  model  reference 
contouring  and  extended  Kalman  filtering  techniques  requires  exten- 
sive digital  computation.   The  digital  computer  programs  (FORTRAN  IV) 
used  for  these  identifications  have  been  written  for  a  very  general 
class  of  ocean  vehicles  of  which  the  DSRV  is  here  used  as  an  example. 
Because  the  computer  programs  are  expected  to  have  more  general 
utility  than  for  the  DSRV,  they  are  included  and  explained  in  this 
thesis. 

This  thesis  is,  in  essence,  the  application  of  one  body  of 
knowledge  to  another.   The  ba.sic  structure  of  the  mathematical  models 
for  ocean  vehicles  is  derived  from  the  Theory  of  Hydrodynamics,   The 
techniques  for  parametric  identification  of  dynamic  systems  are 
derived  from  Modern  Control  Theory,  Lengthy  derivations  in  each 
area  are  referenced,  but  only  the  basic  equations  to  be  used  in  this 
thesis  are  presented  and  discussed. 

This  chapter  has  presented  a  very  general  verbal  statement  of 
the  problem  to  be  considered  in  this  thesis,  parametric  identifica- 
tion for  ocean  vehicle  mathematical  models,  and  the  techniques  to  be 
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used  to  solve  it,  model  reference  contouring  and  extended  Kalman 
filtering.  The  next  chapter  presents,  "by  way  of  introduction,  a 
verbal  view  of  a  general  ocean  vehicle  as  a  black  box  (system)  with 
inputs  and  outputs. 

It  is  possible  to  approach  system  identification  from  either  a 
microscopic  or  a  macroscopic  viewpoint  (G-6).  The  microscopic 
viewpoint  is  one  of  identifying  the  system  by  determining  the  physi- 
cal properties  and  basic  laws  of  science  which  describe  the  behavior 
of  the  individual  parts  of  the  system  and  combining  them.   The  next 
chapter  presents  the  macroscopic  or  black  box  approach  which  uses 
the  system's  input-output  information  to  determine  its  mathematical 
model.  Most  of  the  results  of  this  thesis  are  developed  using  the 
macroscopic  approach,  and  from  that  standpoint,  they  are  most  useful 
in  the  motion  control  of  ocean  vehicles.   For  the  purpose  of  acquir- 
ing a  complete  understanding  of  the  vehicle  behavior,  however,  the 
microscopic  viewpoint  must  eventually  be  used. 
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CHARTER  13 

THE  OCEAN  VEHICLE  AS  A  BLACK  BOX 

For  the  purposes  of  simulation,  control,  and  identification 
it  is  convenient  and  advantageous  to  view  a  general  ocean  vehicle 
as  a  black  box  with  inputs  and  outputs.   Simulation  then  answers  the 
question  "How  does  it  behave?",  control  answers  the  question  "How 
do  we  make  it  do  what  we  want  it  to?" ,  and  identification  answers 
the  question  "What's  inside  it?".   Control  often  requires  or  is 
facilitated  by  simulation,  and  both  control  and  simulation  require 
identification  in  some  form. 

The  subject  of  this  thesis  is  identification,  but  it  is  often 
important  to  know  how  the  identification  is  to  be  used  in  the  overall 
system  operation.   Identification  for  control  may  have  different 
objectives  and  accuracy  requirements  than  identification  for  simula- 
tion.  Identification  for  control  might  be  an  on-line  parametric 
identification  to  allow  the  vehicle  control  system  to  adapt  itself 
to  changes  in  its  environment.   Identification  for  simulation  might 
require  extensive  theoretical  investigations  to  determine  the  model 
structure  and  then  off-line  data  generation  and  processing  to  deter- 
mine parameter  identifiability  or  actual  numerical  values. 

Ocean  vehicles  are  usually  only  parts  of  larger  systems  which 

have  been  designed  to  complete  specified  missions  in  order  to  satisfy 

the  goals  of  societies  or  individuals.   In  order  to  complete  these 

missions,  the  vehicles  must  be  controlled.  Control  requires  knowledge 

of  the  behavior  of  the  vehicle,  and  simulation  and  identification 

provide  that  knowledge.  As  the  missions  which  are  specified  for 

vehicles  in  the  ocean  environment  become  more  complex  and  sophisticated, 
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the  precision  with  which  the  vehicle  must  be  designed  and  controlled 
increases  greatly.   Very  precise  control  of  ocean  vehicles  often 
requires  very  accurate  mathematical  models,  multiple  degree  of 
freedom  control  and  modeling,  and  control  systems  which  are  capable 
of  adapting  to  environmental  and  vehicular  changes. 

An  ocean  vehicle  may  be  represented  by  the  black  box  in  Figure 
I3«l,  where  the  input  is  designated  by  the  vector  u  and  the  output 
by  the  vector  z.      The  sophistication  of  control  systems  increases 
in  several  stages.   The  simplest  control  system  is  the  open  loop 
system  in  which  the  input  u  is  not  dependent  upon  the  output  z_t   but 
is  merely  a  vector  function  of  time.   The  next  step  upward  in  control 

9 

system  complexity  is  the  closed  loop  system  in  which  the  input  u  is 
a  function  of  both  time  and  the  output  vector  z_.   In  both  open  and 
closed  loop  configurations  the  system  S  may  be  partially  known  and 
partially  unknown,  but  in  neither  case  is  its  form  alterable  by  the 
controller  (Figure  I3d). 

An  adaptive  controller  is  a  major  step  above  the  open  and 
closed  loop  controllers  in  complexity  because  limited  and  controllable 
system  structural  or  parametric  variations  are  introduced  (H-2). 
The  limited  system  variations  are  represented  in  Figure  13.1  by  a 
parameter  vector  p_  which  represents  a  set  of  system  parameters  which 
may  be  changed  by  the  controller. 

The  adaptive  controller  can  in  a  limited  (by  the  number  of  elements 
in  p_)  way  change  both  the  input  u  to  the  system  and  some  of  the  char~ 
acteristics  p_  of  the  system,   In  addition,  some  or  all  of  the  param- 
eters p_  may  be  unknown  and  require  identification  by  the  controller. 

If  the  parameters  are  known,  they  may  be  treated  as  additional  inputs 
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Figure  13.1  GENERAL  SYSTEM  AND  TYPES  OF  CONTROLLERS 
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to  the  system,  and  the  adaptive  controller  is  then  in  effect  a 
closed  loop  controller c  If  the  parameters  are  unknown,  the  adaptive 
controller  must  identify  them,  decide  how  to  vary  them  to  meet  the 
goal,  and  modify  the  system  by  actually  changing  them  and  by  varying 
the  inputs.   The  change  in  the  system  is  then  reflected  as  a  change 
or  adaptation  of  the  controller. 

The  past  and  present  control  systems  used  on  ocean  vehicles 
include  all  of  these  types:  open  loop,  closed  loop,  and  adaptive 
control  systems.  An  example  of  open  loop  ship  control  would  be  a 
locked  helm  initially  set  to  a  desired  course  and  then  held  fixed 
for  a  period  of  time.   The  loop  could  be  closed  in  this  control 
system  by  having  a  helmsman  "feedback"  information  from  the  ship's 
compass  and  make  helm  changes  to  keep  the  ship  on   the  desired 
course.  In  this  case  the  helmsman  becomes  the  closed  loop  controller. 

Adaptive  control  has  been  primarily  accomplished  in  the  past  by 
using  human  beings  as  the  controllers  on  ocean  vehicles.  For  example, 
the  captain  of  a  ship  usually  develops  by  experience  a  mental  model 
of  the  ship's  dynamic  behavior  in  response  to  its  inputs.  He  then 
uses  this  mental  model  to  decide  what  bridge  commands  to  issue  in 
order  to  execute  a  maneuver,  such  as  bringing  the  ship  alongside  a 
pier.  If  he  has  a  two-screw  ship  and  loses  one  propellor  due  to  a 
casualty,  he  then  "adapts"  his  mental  model  and  control  commands  to 
execute  the  maneuver  in  spite  of  the  casualty.  The  captain's 
acquisition  of  experience  concerning  the  mental  model  of  the  ship's 
behavior  may  be  likened  to  the  process  of  identifying  parameters  in 
the  vehicle  mathematical  model. 


-? 


37- 


One  of  the  most  important  aspects  of  adaptive  control  is  that 
the  model j  whether  it  'be  a  mental  model  in  the  captain's  mind  or  a 
mathematical  model  in  an  on-board  computer,  permits  the  prediction 
of  the  response  of  the  vehicle  to  a  proposed  input  function.  This 
predictive  capability  can  be  used  to  counteract  the  inherent  time 
delays  in  many  types  of  effectors,  or  it  can  be  used  to  develop  the 
best  inputs  to  the  vehicle  to  accomplish  a  desired  maneuver. 

This  type  of  controller  then  suggests  the  idea  of  an  ocean 
vehicle  which  contains  on  board  a  mathematical  model  of  itself  and 
the  capability  of  identifying  the  parameters  in  that  mathematical 
model  using  the  input -output  data  of  the  vehicle  itself.  Any  control 
system  which  employed  the  predictive  capabilities  of  that  mathemati- 
cal model  could  then  be  made  to  automatically  adapt  to  changes  in  the 
parameters  of  the  vehicle  and  its  environment.   This  form  of  control 
system  is  one  of  many  possible  uses  to  which  the  identification 
techniques  of  this  thesis  and  the  results  of  Modern  Control  Theory 
could  be  applied. 

This  chapter  has  presented  a  brief  and  general  look  at  the 
ocean  vehicle  as  a  black  box  with  input  u  and  output  z.  The  types 
of  control  systems  utilized  for  such  systems  were  described  and 
ocean  vehicle  examples  of  each  type  were  discussed.  Finally,  the  idea 
of  a  vehicle  containing  a  model  of  itself  which  could  be  identified 
and  used  in  the  vehicle  control  system  was  described.  The  next 
chapter  is  an  introduction  to  the  general  process  of  system  identifi~ 
cation o 
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CHAFPER  I/f 

SYSTEM  ]  DEN TI  Fl  CATION 

In  its  most  general  form  system  identification  is  the  process 
of  properly  mathematically  modeling  the  behavior  of  a  given  system. 
This  means  that  it  is  the  process  of  determining  a  set  of  variables 
and  equations  which  will  describe  the  performance  of  the  system  to 
a  specified  accuracy.   The  specified  accuracy  is  usually  determined 
by  the  ultimate  purpose  for  which  the  system  and  the  mathematical 
model  are  to  be  used. 

For  the  studies  in  this  thesis,  system  identification  can 
quickly  be  specialized  to  input-output  or  macroscopic  identification 
of  stochastic  state-determined  dynamic  systems  (Section  M),   The 
most  general  form  of  this  system  is  the  continuous  state-determined 
system  in  equations  1^,1  and  1^,2  which  consists  of  a  set  of  nonlinear 
first-order  vector  differential  equations  and  a  nonlinear  vector 
measurement  function. 

Stochastic  system  identification  for  the  dynamic  system,  in 
equations  14,1  and  1^,2  consists  of  finding  f  and  h  given  u(t)  and 
z_(t)  in  the  presence  of  the  unknowns  or  noises  w  and  v,   There  are  no 
general  solutions  to  this  problem  nor  axe   there  any  completely 
general  techniques  which  may  be  used  to  attack  itt   Therefore,  the 
next  step  is  to  assume  or  to  develop  from  experience  or  theoretical 
studies  the  basic  form  of  the  two  structure  vectors  f  and  h  with  the 
exception  of  a.  finite  number  of  unknown  or  undetermined  parameters  p_. 
This  step  reduces  the  system  identification  problem  to  a  parametric 
identification  problem  for  which  there  exist,  techniques  which  may  be 
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applied  to  specific  systems. 


• 
X 

=  1   (* 

,  u,  w,  t)   ;  x  (tQ)  =  Xq 

14. 

1 

£ 

=  h.  (x 

»  u#  v,  t) 

14. 

2 

Where : 

x  - 

state  vector,  Chapter  M2.1 

u  = 

input  vector  or  control  vector 

w  = 

system  noise  input  vector 

t  » 

time  scalar 

*  cs 

time  derivative  d/dt 

f  = 

system  differential  equation  structure 

vector 

h  - 

system  measurement  structure  vector 

• 

v  = 

measurement  noise  input  vector 

£  = 

system  output  measurement  vector 

Section  M  in  this  thesis  is  designed  to  show  that  ocean  vehicle 
mathematical  models  can  be  placed  into  the  form  of  equations  14.1 
and  14.2  with  f  a.nd  h  known  except  for  a  parameter  vector  p_.  Section 
N  then  presents  the  equations  for  the  techniques  which  may  be  used 
to  find  the  ocean  vehicle  parameters  p_  from  noisy  input-output  data. 
The  model  equations  and  the  identification  equations  are  then  combined 
for  the  remainder  of  the  thesis  to  show  specifically  how  these  tech- 
niques work  for  the  DSRV. 


-40- 


CHARTER  15 

PRIMARY.  CONTRIBUTIONS  OF  THIS  THESIS 

The  primary  contributions  of  this  thesis  are  to  the  area  of 
motion  control  of  ocean  vehicles.   The  major  contribution  to  that 
area  is  the  verification  that  the  techniques  of  model  reference 
contouring  and  extended  Kalman  filtering  are  valid  and  useful  for 
identifying  parameters  in  mathematical  models  with  several  specific 
ocean  vehicle  characteristics  and  equation  forms.   This  chapter 
presents,  in  a  section  by  section  format,  those  areas  which  the 
author  believes  are  contributions  to  and  extensions  of  the  present 
theory  of  motion  control  of  ocean  vehicles. 

Section  2(m)  presents  the  rigid  body  and  hydrodynamic  equation 
structures  for  general  ocean  vehicles.   These  equations  are  then 
placed  into  a  state-space  form  consisting  of  a  single  vector  nonlinear 
differential  equation  in  the  vehicle  primary  states.   The  general 
state  space  equations  in  Chapter  M2,  their  extension  to  include 
fluidic  memory  states  in  Chapter  M3,  and  their  extension  to  include 
higher  derivative  states  of  the  primary  variables  in  Chapter  S2  are 
new  and  do  not  appear  in  the  author's  limited  sampling  of  the  litera- 
ture in  Chapter  Bl, 

Section  3(H)  presents  the  detailed  equations  and  procedures  for 

model  reference  contouring  and  extended  Kalman  filtering.   These 

procedures  come  directly  from  the  literature  of  Modern  Control  Theory 

and  do  not  represent  any  contribution  to  the  theoretical  developments 

of  that  area.   It  has  been  mentioned  (A-13)  that  the  area  of  system 

identification  needs  specific  applications  and  studies  using  its 
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available  techniques  so  that  better  judgements  may  be  made  as  to 
which  techniques  to  select  for  a  given  problem.   In  this  respect 
the  application  of  model  reference  contouring  and  extended  Kalman 
filtering  to  the  specific  DSRV  models  used  in  this  thesis  may  provide 
this  type  of  judgement  information  for  someone  considering  these 
two  techniques  for  his  application.   The  equation  simplifications 
in  Chapter  N3  for  the  extended  Kalman  filter  when  the  parameters 
are  constants  and  the  modelability  and  identifiability  considerations 
of  Chapter  VA   may  also  help  in  that  application. 

Section  4(P)  is  a  detailed  parameter  study  of  the  DSRV  single 
degree  of  freedom  equations  using  these  two  techniques.   The  results 
of  the  studies  of  this  section  show  that  these  techniques  work  on 
these  equations  and  give  the  details  of  how  well  they  work.   This 
knowledge  represents  a  valuable  contribution  to  the  process  of 
mathematically  modeling  the  overall  dynamic  motions  of  ocean  vehicles. 

Section  5(D)  presents  the  DSRV  mathematical  model,  its  gradient, 
and  a  description  of  the  computer  programs  for  calculating  their 
numerical  values.   The  DSRV  mathematical  model  is  taken  from  the 
literature,  but  the  computer  programs  were  developed  specifically 
for  the  general  ocean  vehicle  models  of  Section  2(m)  with  subroutines 
tailored  specifically  to  the  DSRV.   The  author  hopes  that  these 
computer  programs  will  be  useful  to  someone  whose  ocean  vehicle 
model  requires  them  and  fits  their  format.   The  manner  of  storing 
and  addressing  the  DSRV  second  degree  coefficients  in  Chapter  Dl  and 
the  equations  in  Chapter  D4  for  use  in  identifying  the  A-matrix  param- 
eters are  new  to  these  applications. 
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Section  6(C)  presents  studies  of  several  selected  DSRV  coeffi- 
cients and  parameters  for  multiple  degree  of  freedom  models  to  shovf 
that  the  parameters  may  be  identified  in  more  complicated  ocean 
vehicle  models  than  those  of  Section  'l(P).  The  highly  flexible 
computer  programs  for  accomplishing  this  are  discussed  briefly  con- 
cerning their  structure-selectivity  aspects  and  their  utilization  for 
general  ocean  vehicle  models.  As  in  Section  4(P)  the  studies  of  this 
section  show  that  these  techniques  are  valid  for  the  DSRV  mathemati- 
cal model  and  as  such  represent  some  of  the  major  contributions  of 
this  thesis. 

Section  7(s)  is  a  brief  summary  of  the  thesis  and  a  description 
of  a  large  number  of  areas  for  further  research  vrhich  may  be  conducted, 
Section  8(a)  is  a  series  of  appendices  containing  numerical  values, 
computer  programs,  and  studies  by  the  author  of  areas  related  to  the 
research  in  this  thesis.  Section  9(b)  is  primarily  a  bibliography  of 
276  references  from  the  areas  of  Ocean  Engineering  and  Modern  Control 
Theory.  It  is  the  author's  intent  that  these  three  sections  contain 
information  vrhich  is  ancillary  to  the  main  thesis  research  but  useful 
for  someone  vfho  desires  to  directly  use  the  results  of  previous 
sections  for  his  ocean  vehicle  investigations. 

The  purpose  of  this  section  has  been  to  introduce  the  reader 
to  the  research  and  organization  of  this  thesis  by  briefly  and  very 
generally  discussing  the  areas  to  be  covered.   The  next  section  begins 
these  research  studies  by  developing  state  space  mathematical  models 
for  ocean  vehicles. 
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SECTION'  2 

MATHEMATICAL  MODELING  OF  OCEAN  VEHICLE  DYNAMICS  (h) 

Ml   GENERAL  OCEAN  VEHICLE  DYNAMIC  EQUATIONS 

M2   STATE  SPACE  REPRESENTATION  FOR  OCEAN  VEHICLES 

M3   PECULIARITIES  OF  OCEAN  VEHICLE  MODELS 

M4   OCEAN  VEHICLE  MODELS  WITH  UNCERTAIN  STRUCTURE 


"KNOWLEDGE  IS  MORE  THAN  EQUIVALENT  TO  FORCE."  - 

SAMUEL  JOHNSON  (1709-1784) 


THE  CENTRAL  PURPOSE  OF  THIS  THESIS  IS  THE  DEVELOPMENT,  PRESENTATION, 
DSRV  UTILIZATION ,  AND  ANALYSIS  OF  TECHNIQUES  FOR  THE  IDENTIFICATION 
OF  PARAMETERS  IN  AN  OCEAN  VEHICLE  DYNAMIC  MATHEMATICAL  MODEL.   THIS 
SECTION  IS  INTENDED  TO  PROVIDE  A  COMPLETE  MATHEMATICAL  MODELING 
FRAMEWORK,  OF  WHICH  THE  DSRV  IS  A  SPECIAL  CASE,  IN  ORDER  THAT  THE 
PARAMETRIC  IDENTIFICATION  TECHNIQUES  OF  THE  NEXT  SECTION  MAY  BE  SHOWN 
TO  APPLY  GENERALLY  TO  SUCH  OCEAN  VEHICLE  DYNAMIC  MODELS,   LATER 
SECTIONS  THEN  UTILIZE  BOTH  THE  MODELS  OF  THIS  SECTION  AND  THE  IDENT- 
IFICATION TECHNIQUES  OF  THE  NEXT  SECTION  TO  DETERMINE  THE  IDENTIFI- 
ABILITY  OF  SPECIFIC  PARAMETERS  FOR  THE  DSRV, 
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CHAPTER  Ml 

GENERAL  OCEAN  VEHICLE  DYNAMIC  EQUATIONS 

This  section  presents  the  development  of  the  general  state 
space  equations  for  mathematically  modeling  overall  ocean  vehicle 
dynamic  motions.  It  begins  with  a  statement  and  referencing  of 
the  dynamic  equations  thus  far  developed  in  the  literature,  and 
then  presents  the  details  of  their  conversion  to  state  space  form. 
The  peculiarities  of  ocean  vehicle  models  such  as  nonlinearities, 
fluidic  memory,  measurement  functions  and  partially  unknown  structure 
are  then  shown  to  fit  the  state  space  format  and,  therefore,,  to  fit 
directly  into  the  system  identification  problem  discussed  in  Chapter  I 4. 
The  section  concludes  with  a  discussion  of  the  procedures  to  be 
followed  in  modeling  uncertainties  in  mathematical  model  structure 
using  stochastic  processes. 
Ml . 1  INTRODUCTION  TO  MODELING  OCEAN  VEHICLES 

In  order  to  understand  the  physical  behavior  of  an  ocean  vehicle, 
man  utilizes  observations  of  the  vehicle  itself,  a  physical  model  of 
the  vehicle,  or  a  mathematical  model  of  the  vehicle.  This  under- 
standing of  vehicle  behavior  can  then  be  utilized  to  help  design, 
build,  or  operate  the  vehicle  to  meet  its  specified  mission.  Our 
concern  here  is  with  mathematical  models  to  simulate  overall  motion, 
although  the  vehicle  being  mathematically  modeled  may  be  a  full-scale 
ocean  vehicle  or  a  physical  model  of  it  for  use  in  towing  tank  or 
self-propelled  experiments, 

A  mathematical  model  for  a  dyna.mic  system  consists  of  two  parts: 
equation  structure  and  initial  conditions.  For  ocean  vehicles  the. 
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equation  structure  for  overall  motion  usually  consists  of  sets  of 
differential  equations,  and  the  initial  conditions  represent  the 
values  of  the  variables  in  the  differential  equations  at  a  beginning, 
specific  time  of  interest  to  the  observer.  Once  the  equation  struc- 
ture and  initial  conditions  for  the  dynamic  system  are  known,  the 
system  can  be  simulated  by  solving  the  equations  in  some  manner  for 
a  specified  input. 

This  chapter  presents  one  form  of  the  basic  equation  structure 
for  a  general  ocean  vehicle  and  references  its  derivation  in  the 
literature.  Much  of  the  notation  used  is  either  described  in  the 
cited  references  or  in  Chapter  T2,  Tfrere  appears  to  be  two  basic 

« 

methods  for  arriving  at  these  equations:  energy  methods  and  vector 
calculus.  The  energy  method  uses  lagrangian  state  functions  and 
Lagrange's  equation  and  is  described  by  Lamb  (L-8),  Dogan  (B-2), 
and  Tufts  (T-l)  to  name  only  a  few.  A  state  space  viewpoint  of  this 
method  is  given  by  Schultz  and  Melsa  (S-7),  Long  (L-5)  and  many 
others.  The  vector  calculus  method  consists  in  essence  of  a  vector 
expansion  of  Newton's  laws  of  motion  and  a  Taylor  series  expansion 
of  the  hydrodynamic  forces  and  moments.  This  method  is  derived  in 
detail  and  presented  by  Abkowitz  (A-l)  (A-ll).  The  vector  calculus 
method  will  be  briefly  described  in  this  chapter  and  its  results  used 
throughout  this  thesis  because  the  method  leads  readily  to  the  ampli- 
cation of  system  identification  techniques. 

There  are  two  basic  types  of  dynamic  equation  structure  to  be 
developed  for  the  mathematical  simulation  cf  an  ocean  vehicle:  the 
rigid  body  structure  and  the  hydrodynamic  structure.  The  rigid  body 
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structure  is  a  collection  of  terms  involving  the  vehicle  mass, 
moments  of  inertia,  velocities,  and  accelerations  combined  to  satisfy 
Newton's  Law,   The  hydrodynsj.iic  structure  is  a  set  of  terms  involv- 
ing variables  which  express  properties  of  the  body  of  the  vehicle, 
properties  of  its  motion,  and  properties  of  the  fluid  through  which 
it  is  moving  (A~l).   The  ocean  vehicle  dynamic  mathematical  model 
is  then  expressed  by  equation  Ml.l  and  some  statement  of  the  initial 
conditions  of  the  vehicle  at  time  t  ,  Both  sides  of  this  equation 


Rigid  Body  Structure  =  Hydrodynamic  Structure 

Vehicle  (t  )  -  Xq  Ml.l 


represent  the  forces  and  moments  on  the  vehicle. 
Ml. 2  NEWTON'S  LAW  -  THE  LEFT  SIDE  OF  EQUATION  Ml.l 

The  overall  motion  of  an  ocean  vehicle  when  modeled  as  a  rigid 
body  motion  must  satisfy  Newton's  Law  as  in  equations  Ml. 2  and  M1.3» 


d  (Momentum)   Fo 

dt  "  Ml, 2 


d  (Angular  Momentum)  _  Mo_ 

dt  Ml. 3 


The  essence  of  these  equations  is  that  the  forces  and  moments 

(Fo,  Mo)  acting  on  the  vehicle  must  equal  the  time  rate  of  change 

of  the  momentum  and  the  angular  momentum  in  a.  center-of-gravity 

coordinated  system.  The  fact  that  the  origin  of  the  coordinate 

system  is  not  at  the  center  of  gravity  (C,G.)  and  is  moving  for  a 

general  ocean  vehicle  means  that  these  equations  must  be  expanded 

in  terms  of  the  vehicle  mass,  (n),  vehicle  velocities  (u  v  M  p  q  r) 

-47- 


relative  to  a  coordinate  system  (x  y  z  0  9  If)  moving  with  the  vehicle, 
and  the  vehicle  accelerations  (u  v  w  p  q  r) . 

These  equations  and  the  complete  details  of  the  expansion  for  a 
vehicle  of  constant  mass  and  time  invariant  center  of  gravity  location 
are  given  "by  Abkowitz  (A~l).  .  The  equations  for  a  vehicle  with  an 
accelerating  center  of  gravity  are  presented  by  Tufts  (T-l,  p.  17). 
The  equations  for  a  vehicle  with  changing  mass  can  be  developed  by 
using  equation  Mle^  referenced  to  the  derivation  in  reference  (A~llt 
p.  36)  and  by  taking  into  account  the  fact  that  the  moments  and  cross 


dmlL,  +  md_UGwFo 

dt       dt  Ml.fc 


products  of  inertia  will  also  be  time  varying  in  equation  Ml  .3*   The 
variable  mass,  variable  C.G.  equations  could  also  be  fit  into  the 
identification  procedures  used  in  this  thesis.        .  , 

The  force  and  moment  equations  to  be  examined  in  this  thesis 
with  reference  to  the  D3RV  are  taken  from  Abkowitz  (A-l)  for  a  constant 
mass  and  constant  center  of  gravity  vehicle  and  listed  as  equations 
Mle5  ~  Ml. 10  for  the  six  vehicle  forces  and  moments  (X  Y  Z  K  M  N). 


Rigid 

Body  Structure 

• 

r* 

Iu|_U  + 

qw  -  rv  -  xQ  (q2  +  r2)  +  yQ   (pq  - 

r)  +  zQ  (pr  +  q)]  --  X 

Ml.  5 

m[v  + 

ru  -  pw  -  yG  (r2  +  p2)  +  zQ  (qr  « 

p)  +  xr  (qp  +  *)]  «  Y 

m[_w  + 

pv  -  qu  -  zG  (p2  +  q2)  +  x  (rp  - 

4)  +  Yr   (rq  +  p)]  -  z 

,          Ml. 7 

. 

Ip  + 

X 

(lz  -  I  )  qr  +  m[yQ  (w  +  pv  -  qu) 

-  zr  (v  +  ru  -  pw)]  =  K 

b            Ml. 8 

I  q  + 

y 

(lx  -  Iz)  rp  +  m[zQ  (u  +  qw  ~  rv) 

~  xp  (w  +  pv  -  qu)]  =  M 

Ml. 9 

I  r  -{- 

2 

(ly  ~  Ix)  Pq  +  »[xq  (v  +  ru  -  pw) 

-  yr  (u  +  qw  -  rv)]  =  N 

ha. 10 

s 
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For  coordinate  axes  parallel  to  the  principal  axes  of  inertia, 

these  equations  satisfy  Newton's  Law  for  the  motion  of  the  vehicle 

as  a  rigid  body  in  space  with  six  decrees  of  freedom  and  represent, 

in  a  way,  half  of  the  structure  of  the  mathematical  model  differential 

equations,  or  the  left  side  of  equation  Ml.l. 

^••3  HYDRODYNAMIC  STRUCTURE  -  THE  RIGHT  SIDE  OF  EQUATION  Ml.l 

The  overall  motion  of  an  ocean  vehicle  through  a  fluid  results 
in  and  from  forces  and  moments  functionally  related  to  the  properties 
of  the  vehicle  body,  the  vehicle  motion,  and  the  fluid  (A-l),   The 
hydrodynamic  structure  has  been  defined  here  to  represent  all  of  the 
forces  and  moments  acting  upon  the  vehicle  vdth  the  exception  of 
the  rigid  body  or  Newton's  Law  forces.  For  the  purposes  of  this 
thesis,  the  hydrodynamic  structure  will  be  broken  into  the  sum  of 
three  component  parts s  hydrodynamic  forces,  gravity  forces,  and 
effector  forces  as  in  equations  M1.}.1  and  Ml.  12. 

It  must  be  emphasized  at  this  point  that  the  reduction  of 
equation  Ml. 11  to  Ml. 12  is  a  significant  one  and  must  be  justified 
for  the  particular  ocean  vehicle  being  modeled.  This  reduction 
says  in  effect  that  there  is  a  way  to  linearly  uncouple  the  effector 
forces  from  the  hydrodynamic  forces.  This  may  be  generally  expected 
to  be  true  as  long  as  the  motion  and  effector  limitations  which  are 
implied  by  the  uncoupling  are  determined  for  that  vehicle. 

Hydrodynamic  Structure  =  f(Body,  Motion,  Fluid)       Ml. 11 

Hyd.  Structure  ■  Hyd.  Forces  +  Gravity  Forces  +  Effector  Forces 

Ml.  12 

Where : 

Hydrodynamic  Forces  =  f (Motion) 
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Gravity  Forces  «  f(Body,  Motion,  Fluid) 
Effector  Forces  «=  f(Body,  Motion,  Fluid) 

The  hydrodynamic  forces  are  those  resulting  from  the  dynamics 
of  the  vehicle,  not  including  the  vehicle  effectors,  'ihese  forces 
are  the  result  of  hydrodynamic  inertia!  efforts  which  produce  "added" 
masses  and  of  skin  friction,  separation,  circulation,  and  cross- 
flow  (secondary)  drag  effects.  The  hydrodynamic  forces  are  here 
considered  to  bo  functions  of  the  vehicle  velocities  and  accelera- 
tions, hut  more  general  formulations  can  be  made  and  used  in  the 
identification  procedures  (see  Chapter  M3)#  The  fact  that  these 
forces  depend  upon  a  limited  and  specific  number  of  variables  means 
that  a  general  structure  for  the  hydrodynamic  forces  can  be  developed 
and  applied  to  a  large  class  of  ocean  vehicles  using  a  Taylor  series 
expansion. 

The  effector  forces  are  generally  functions  which  are  specific 
to  the  vehicle  under  examination  and  only  limited  and  specific 
structure  can  be  developed.  This  means  that  the  effectors  for  a 
given  vehicle  are  best  modeled  for  that  vehicle  or  class  of  vehicles 
rather  than  by  trying  to  find  an  all-encompassing  system  of  equations 
which  describes  a  large  number  of  effectors  for  a  large  number  of 
different  vehicles. 

The  gravity  forces  are  produced  by  the  creation  of  a  buoyancy 
force  B  through  the  center  of  buoyancy  xB  caused  by  the  hydrostatic 
pressure  of  the  fluid.   If  the  fluid  properties  are  constant,  the 
vehicle  volume  and  buoyancy  are  constant,  and  the  vehicle  mass  is 
constant}  then  the  gravity  equations  depend  primarily  upon  the  vehicle 
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orientation.   These  equations  are  relatively  simple  and  standard 
and  are  presented  in  Chapter  D3.2,  in  references  (T-l,  p.  21 ) 
(B-2,  p.  27),  and  are  included  in  the  equations  of  motion  in 
reference  (B-9f  P«  ^.2.1).  For  the  purposes  of  this  thesis  the 
gravity  terms  are  included  in  the  effector  equations. 

The  hydrodynarnie  structure  can  novr  be  summarized  in  equations 
Ml. 13  through  Ml. 18  which  represent  the  right  side  of  equation  Mid 
and  of  equations  Ml. 5  through  Ml. 10.  At  this  point  the  only  equation 


Hydrodynamic  Structure 

X  =>  Xv.,,,3    (uvwpqruvwpqr)-f  X   ~r(Body,   Motion,   Fluid) 
hyl  ~  e±i  Ml. 13 

Y  ~  Y.     ,   (u  v  w  p  q  r  u  v  w  p  q  f)  +  Y   „„(Body,   Motion,   Fluid) 
nyd  eli  KL.14 

Z  -  Z  (u  v  w  p  q  r  u  v  w  p  q  r)   +  Z   „,.(Body,   Motion,   Fluid) 

hyd  '  e11  141.15 

K  =  K,     ,   (u  v  w  p  q  r  u  v  w  p  q  r)  +  K   „ ..(Body,   Motion,   Fluid) 

Ml,  16 

M  -  M,  ,  (u  v  w  p  q  r  u  v  w  p  q  f)  +  M  „p(Body,  Motion,  Fluid) 
nya  eli  Ml. 17 

N  =  N    (u  v  w  p  q  r  u  v  w  p  a  f)  +  N   (Body,  Motion,  Fluid) 
hya  ell  Mla8 


structure  really  known  is  the  rigid  body  structure;  the  functions  in 

equations  Ml. 13  through  Ml»l8  are  still  unknown.  The  structure  of 

the  hydrodynamie  forces  is  usually  set  by  expanding  these  functions 

in  a  truncated  Taylor  series.  The  structure  of  the  effector  forces 

is  usually  determined  by  theoretical  and  experiments!  analysis  for 

a  particular  effector  and  vehicle.  Once  the  variables  have  been 

specified  in  the  effector  force  terms,  they  can  also  be  expanded  in 

a  Taylor  series. 
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This  chapter  has  presented  and  referenced  the  development  of 
the  equation  structure  for  mathematically  modeling  a  general  ocean 
vehicle.   This  model  structure  has  been  shovrn  to  consist  of  a  known 
set  of  terms  which  make  up  the  rigid  body  structure  and  an  undeter- 
mined set  of  terms  which  make  up  the  hydrodynamic  structure.   The 
next  chapter  develops  the  state  space  form  for  these  equations  and 
presents  the  Taylor  series  expansion  equations  for  the  hydrodynaraic 
forces  and  moments. 
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CHAPTER  M2 

STATE  SPACE  REPRESENTATION  FOR  OCEAN  VEHICLES 

State  space  representations  for  multi variable,  multidimensional 
systems  are  easier  to  write  down  and  are  easier  to  compute  then 
explicit  variable  representations.  For  ocean  vehicle  dynamic  equations 
the  state  space  format  is  nothing  more  than  calling  the  primary 
explicit  variables  by  different,  ordered,  and  indexed  names.  Once 
these  equations  have  been  placed  in  the  state  space  form  the  wealth 
of  recent,  powerful,  organized,  and  practical  results  from  modern 
control  theory  can  be  applied  to  the  understanding  of  the  ocean 
vehicle,  • 

The  purposes  of  this  chapter  are  to  provide  the  background 
necessary  to  understand  what  the  state  of  a  system  means,  to  present 
the  dynamic  equations  of  Chapter  Ml  in  state  space  form,  and  to 
develop  the  structure  of  the  hydrodynamic  forces  and  moments  by 
Taylor  series  expansion,  The  equations  and  coefficients  presented 
here  are  the  general  forms  to  be  coupled  into  the  model  reference 
and  extended  Kalman  filtering  equations  presented  in  Section  3  00 . 
K2 , 1  THE  STATE  OF  A  DYNAMIC  SYSTEM 

The  state  of  a  dynamic  system  is  the  minimum  set  of  numbers 

xl^o^r  x2^  )•"**•  *rX^   )  Hhi°h»  in  combination  with  the  input 
to  the  system  u(t)  for  time  t  >  t  ,  is  sufficient  to  determine  the 
behavior  of  the  system  for  all  time  t  >  t  .  This  means  that  the 
state  is  the  minimum  amount  of  information  about  the  system  needed 
to  determine  its  future  behavior  without  reference  to  its  past  inputs. 
In  essence,  the  concept  of  the  state  of  a  system  divorces  the  system 
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from  its  past  behavior.  In  this  thesis,  as  in  most  of  the  litera- 
ture, the  states  and  inputs  are  represented  as  column  vectors  x  and 
u  as  in  equation  M2.1. 


x(t) 


*i(t) 
x2(t) 


xn(t) 


u(t)  •-= 


ul(t) 

u?(t) 


Um^) 


H2,l 


A  dynamic  system  which  can  be  represented  by  states  and  state 
equations  is  called  a  state  determined  dynamic  system.  The  equations 
for  representing  such  systems  usually  consist  cf  n  first-order 
differential  or  difference  equations,  and  the  form  of  these  equations 
is  called  the  mathematical  structure  of  the  system,  A  ncn-state- 
determined  system  would  be  one  which  requires  an  infinite  set  or 
continuous  set  of  numbers  x(n,  t)  to  specify  its  behavior  at  any 
time.  Such  systems  are  usually  represented  by  sets  of  partial 
differential  equations, 

A  dynamic  system  is  one  which  changes  state  as  a  function  of 
time  and  is  represented  by  equation  M2.2  and  diagrammed  in  Figure  M2.1. 
The  structure  of  the  dynamic  system  is  expressed  by  the  time  deriva- 
tives of  the  individual  states,  and  a  time  invariant  structure  means 
that  the  values  of  the  derivatives  in  the  structure  do  not  depend 
explicitly  upon  time.  The  essence  of  equation  M2.2  is  that  knowing 
x  at  time  t  means  that  wc  ca.n  determine  x  at  an  infinitesimal  time 
later  by  adding  x(t)  +  x(t)  dt. 

Most  ocean  vehicle  dynamic  structure  is  intended  to  be 
time  invariant  and  so  almost  all  of  the  equations  in  this  thesis  are 
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of  time  invar lent  structure.   After  all,  if  we  have  a  system  of 
differential  equations  which  model  a  vehicle  on  one  day,  ve  hope 
that  the  same  equations  will  be  valid  the  next  day.  Some  examples 
of  time  varying  behavior  for  a  ship  might  be  the  growth  of  barnacles 
on  the  hull  causing  the  ship's  drag  to  increase  with  time  or  the 
wearing  out  of  machinery  causing  its  properties  to  vary  with  time. 
In  both  of  these  examples  the  time  variance  can  be  eliminated  by 
making  the  parameters  which  vary  into  states  in  the  system  of  equa- 
tions modeling  the  vehicle.   The  time  invariant  form  of  equation  M2.2 
is  given  by  M2.3. 


*  ~  £  (*«  H»  t) 


v 

x  =  f  (x,  u) 


M2.2 
M2.3 


M2*?-  THE  STATE  OF  AN  OCEAN  VEHICLE 

Given  a  vehicle  underway  in  the  ocean  environment,  what  are 

n  numbers  x  which,  in  combination  with  the  inputs  u(t)  to  the  vehicle 

for  all  future  time,  will  completely  specify  the  dynamic  behavior  of 
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the  vehicle  for  all  future  time?  These  n  numbers  are  the  sum  of 
the  n-,  properties  of  the  body  of  the  vehicle,  the  np  properties  of 
the  vehicle  motion,  and  the  n^  properties  of  the  fluid  (ocean).   If 
the  fluid  properties  and  the  body  properties  are  constant,  then  the 
motion  properties  specify  the  vehicle  behavior  and  are  designated 
the  states  of  the  system,  A  partial  listing  of  motion,  fluid,  and 
body  properties  is  given  in  Chapter  T2  and  in  reference  (A-l). 

The  properties  necessary  to  specify  the  state  of  the  D3RV,  the 
example  vehicle  analysed  in  this  thesis,  are  the  six  vehicle  veloc- 
ities, three  vehicle  angles,  three  location  variables  for  the  center 
of  gravity,  the  vehicle  weight,  the  vehicle  second-degree  coefficients 
(126)  and  all  of  the  vehicle  parameters  (587).   This  makes  a  total 
of  852  states  which  specify  the  dynamic  behavior  of  the  DSRV  mathe- 
matical model  at  any  point  in  time.   The  initial  value  of  these 
states,  the  structure  of  the  equations  f,  and  the  input  values  u(t) 
completely  specify  the  mathematical  model  for  the  DSRV  and  fit 
directly  into  equation  M2,3»  For  an  identification  problem  all  of 
these  must  be  considered  states,  but  for  a  general  simulation  the 
C.G.,  weight,  second-degree  coefficients,  and  vehicle  parameters  are 
considered  to  be  constant.  In  that  case,  the  DSRV  states  reduce  to 
the  vehicle  velocities  and  angles  (u  v  w  p  q  r  0  6  "&) ,  and  the  state 
vector  may  be  then  defined  as  x  =  Cu»  v»  v;»  P«  Q»  r»  0»  8,^3  ,  The 
DSRV  states  are  described  here  merely  as  an  example  of  a  few  of  the 
considerations  necessary  in  defining  the  states  of  a  vehicle. 

For  the  remainder  of  this  thesis,  the  vehicle  velocities  will 

be  considered  the  primary  states  and  will  be  defined  by  equation  112, 4. 

The  vehicle  angles  are  included  in  the  effector  (gravity)  functions, 
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This  is  a  somewhat  arbitrary  and  easily  changed  definition  as  villi 
"be  seen  in  later  sections  where  the  vehicle  coefficients  and  param- 
eters are  "augmented"  or  "stacked"  into  the  general  state  vector  x. 
The  state  vector  will  generally  consist  of  those  variables  which 
change  as  the  vehicle  mathematical  model  executes  a  maneuver, 
M2. 3  TAYLOR  SERIES  EXPANSION  OF  THE  HYDRODYN.AHIC  FORCES  AND  MOMENTS 

As  mentioned  previously,  mathematical  modeling  begins  with  the 
statement  cr  definition  of  state  variables  and  inputs.  The  basic 
structure  of  the  differential  equations  for  the  mathematical  model 
is  then  developed  in  terms  of  these  variables  using  theoretical  and 
experimental  techniques.  Chapter  Ml  discusses  the  development  of  the 
rigid  body  structure  for  the  primary  states  defined  in  equation  M2.*J- 
and  presented  it  in  equations  Ml, 5  through  Ml, 10,  The  next  step  is 
to  determine  some  form  for  the  hydrodynamic  structure  in  equations 
Ml. 13  through  Ml, 18. 

It  is  convenient  at  this  point  to  define  a  force  vector  X  as  in 
equation  M2.5  and  to  utilize  it  to  write  the  six  structure  equations 
as  one  vector,  state  space  equation  H2.6,  This  convention  serves  to 
simplify  the  writing  of  these  equations  and  to  simplify  their  computa- 
tion since  they  must  eventually  be  calculated  using  a  digital  computer 
program. 
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X  -  Xhyd  (x,  x)  -:-  X^ff   (Body,  Motion,  Fluid)      M2.6 


One  method  of  generally  specifying  the  structure  of  the  term 
2L  *   (— '  — ^  ^"n  e(3ua't^on  M2.6  is  "by  expanding  it  in  a  Taylor  series 

about  some  nominal  values  of  the  state  x  and  state  derivative  x 

— o  -o 

and  then  by  some  means  specify  the  coefficients  or  nominally  evaluated 
partial  derivatives  of  the  terms  in  the  series.  It  must  be  emphasized 
that  the  Taylor  series  is  by  no  means  the  only  way  to  begin  specifying 
structure  at  this  point.  Perhaps  a  Fourier,  Bessel,abs.  squa-e,. or  other 
series  expansion  with  coefficients  to  be  determined  by  identification 
could  be  utilized  here.  If  theoretical  or  experimental  investiga- 
tions for  specific  vehicles  contain  any  results  which  will  help 
specify  the  structure  of  XhVri»  they  should  be  used  at  this  point  in 
the  mathematical  modeling  process  (see  also  Chapter  M3«3)»   In  the 
literature,  the  structure  of  X,  ,  is  often  specified  by  a  Taylor 
series  containing  the  linear  terms;  see  for  example  Salves en,  et  al, 
(S-10),  Abkowitz  (A-l),  Mandel  (C-4),  ^ees  (R-8)i  and  Goclowski(G-8). 

The  general  form  of  X,  ,  to  be  investigated  in  detail  in  later 
sections  of  this  thesis  is  the  Taylor  series  expansion  about  x  "  £0  = 

0  with  the  retention  of  only  the  second-degree  terms  in  x  and  the 
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linear  terns  in  x.   The  methods  used  in  the  study  of  the  second- 
degree  coefficients,  hov;ever,  apply  generally  to  other  terms  in  the 
Taylor  series  or  to  other  coefficients  in  other  types  of  series 
expansions.  The  Taylor  series  expansion  of  X.  d  (x,  x)  for  x  being 
the  vehicle  velocities  is  given  by  equation  K2.7. 


2W  (*  *)  -  ^  Cfti  PJ  +  sai  ^M 


^hyd 


-iiyd 


6   ^  ,, 
x.  +  E 


"I  7*^ 


Xi  + 


6   6   ,  &  X,  , 

i=l  i=.l  £  dx.dx . 
i  0 


6   6   ,  <)'\  . 

v   y   1  nyd 

i  ^0  T  3k  i-1  2  ^x. 


X.  x 


xixj  + 


6   6   <)3* 
j=l  i*l  ^x^x 


hyd 


.      6   6   6  1  ^a_ 
o  i  J   n»l  j=l  ial  6  d\dxf\ 


X.  X.  X   + 

3-  J  n 


6   6   6   !^\vd 
n=l  j=l  i=l  o  0\}xJxn 


X.  X  .  X 

i  n  n 


6   6   6   xa34 

£   I!   £   ;r  tt — r" 
n=l  j=l  1=1  2  dxjx.dk 


l  j  n  o 


X.  X.  X   + 

i  J  n 


6   6   6   x  ^  2^d  _ 
n=l  j»l  i=l  %d\)*j*n 


X.  X  .  X   +  •  •  • 

i  J  n 


M2.7 


The  terras  on  the  right  hand  side  of  equation  M2.7  which  involve 
the  derivatives  of  X,  ,  evaluated  at  (x,  x)  are  called  the  coefficients 
of  the  hydrodynamic  forces  and  moments,,  In  the  mathematical,  simulation 
of  the  vehicle,  these  coefficients  are  constant  and  are  designated  as 
vehicle  parameters.  In  the  identification  equations  of  later  sections, 
however,  these  coefficients  are  not  constants  but  become  variables  and 

are  designated  as  vehicle  states.  Equation  M2.7  represents  a  completely 
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generalized  and  state  space  formulated  version  of  equation  (75)  on 
page  5^3  in  PNA,  reference  (C»^!-). 


Without  Symmetry__ 

Type  of  Coefficient 

With  Symmetry 

6 

constant 

6 

36 

linear  x 

36 

36 

linear  x 

36 

216 

second  degree  x 

126 

216 

second  degree  x 

126 

216 

second  degree  cross  product  xx 

216 

1296 

third  degree  x 

336 

1296 

third  degree  x 

336 

1296 

third  degree  cross  xxx 

756 

1296 

third  degree  cross  xxx 

756 

Table  M2.1  NUMBERS  OF  COEFFICIENTS  THROUGH  THIRD  DEGREE 


Many  of  the  coefficients  in  equation  M2,7  are  repeated  because  of  the 
continuity  and  symmetry  of  the  expansion.  For  example,  let  the  second 
degree  coefficients  be  defined  by  equation  M2,8  as  X,  .,  In  that  case, 

J.  J 


i,j  -  1,6 


M2.8 


symmetry  requires  that  X.  .  ■  X..  and  therefore  the  216  possible  X.  . 

-ij   -ji  r       -a.  j 

coefficients  reduce  to  126  possible  unique  coefficients.   The  numbers 

of  unique  coefficients  including  symmetry  are  also  listed  in  Table  M2.1. 

The  total  mathematical  model  for  the  dynamics  of  a  general  ocean 

vehicle  consists  of  the  rigid  body  structure  of  equations  Ml, 5  through 
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Ml. 10  (in  state  space  form),  the  hydrodynamlc  structure  of  equation 
M2.6,  end  the  Taylor  series  structure  for  the  hydrodynamlc  forces 
and  moments  in  equation  M2.?«   The  state  space  form  for  the  rigid 
body  structure  in  equations  Ml. 5  through  Ml. 10  is  given  by  equations 
M2.9  through  M2.14.  In  order  to  place  the  total  mathematical  model 
into  state  space  form,  the  vehicle  state  derivative  x  must  be  either 
explicitly  or  implicitly  solved  for  in  terms  of  the  states  x  and 
vehicle  parameters. 


State  Space  Form  of  Rigid  Body  Structure 

m  [^  +  x5  x3  -  x6  x2  -  x1Q(x^  +  xg)  +  x2G(x4  x$  -  kj 

+  x3G(x^  x6  +  x5)]  -  X  M2.9 


m 


[x2  +  x6  xx  -  x4  x3  -  x2G(x|  +.  **)  +  x3Q(x5  x6  -  X/f) 
C1G^X5  \  +  x6 


2 
+  xir(x.  Xk  +  *•)]  -  X  M2.10 


m  [x3  +  x^  x2  -  x5  X]L  -  x3G(xJ  +  x*)  +  x1G(x6  x^  -  x^) 

3 

+  x£q(x5  x5  +  x^)]  *  ^  M2.ll 

\  \  +  ^x3  "  \^  x5  X6    '•  "  1>2G  (S  +  ^  X2  "  X5  V 

-  x3q(x2  *  x6  xj    "  \  x3^3  B  X  M2.12 

T'x2  *$  +  ^  "  Ix3)  x6  x2f  +  ra  I>3G(xi  +  x5  x3  "  x6  x2} 

"  X1G^X3  +  \  x2  "  x5  xi^  "  X  r'12a3 


S  *6  +  (lx2  "  \*  \  x5  +  n  CxiG(x2  +  x6  xl  -  x4  x3> 

"  x2g(*i  +  x5  x3  "  x6  xo)]  "  x  M2,l^ 
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M2 . 4  SOLVING  THIS  GENERAL  EQUATIONS  FOR  x. 

In  order  to  mathematically  simulate  an  ocean  vehicle  as  the 
state  determined  dynamic  system  shown  in  Figure  N2.1,  the  state 
derivative  x  must  be  calculated  for  each  increment  of  time  the 
system  runs.  This  means  that  the  general  ocean  vehicle  equations 
thus  far  developed  either  must  he  manipulated  into  a  form  so  that 
an  explicit  solution  for  x  may  be  calculated  or  must  be  solved  for 
x  implicitly  at  each  time  step  by  finding  the  solution  to  a  nonlinear 
algebraic  expression  involving  x.. 

The  beginning  steps  in  any  explicit  solution  for  x  are  to  expand 
the  rigid  body  structure,  collect  the  primed  derivatives,  and  write 
the  equations  in  vector  form  as  in  equations  112,15  through  M2.23. 
This  then  allows  the  total  ocean  vehicle  mathematical  model  to  be 
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fr  -  ~m  [x5  x3  -  x6  x2  -  x1G  (x|  +  x|) 

+  X2G  \  x5  +  X3G  \  x6-l 
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M2.18 


2 

fr  -  -a  [x6  xx  -  x^  x3  -  x2G  (xg  +  x*) 

+  x3G  x5  x6  +  x1G  x5  x^]  M2.19 

3 

fr  =  "m  Ex4  x2  "  x5  x].  "  X3G  (x£  *  X<P 

+  X1G  x6  x4  +  X2G  x6  x5^  M2*20 

fr  =  -  ^x3  "  \)  x5  x6  "  m  tx2G  (\  x2  "  x5  xx) 

-  x^q   (x^  x^  -  x^  x~)]  M2.21 

fr  =  -  (IX]   "  Ix3)  x6  \  -  m  [>3G  <x5  x3  "  X6  x?)     ■ 

"    X-i/i    \X|,    X^    —    Xj-    X-.  ^  J  Vic. » ex. 

f    =  -  (i       -  I     )  x.    x„  -  m  ("x,      (x,  x     -  x,    x  ) 

x2         xi       ^     5  L1GV6     1         l\     y 

"  X2G  <x5  x3  ~  x6  x2)]  M2-23 

written  as  equation  M2.240      If  the  vehicle  effector  structure  X   «^ 

—off 

contains  terms  involving  x,  these  terms  would  be  included  in  the  left 
hand  side  of  equation  M2.24.  For  a  given  value  of  x,  the  state 


derivative  x  is  now  theoretically  calculable  by  an.  implicit  solution 
of  equation  M2.2^.  The  calculation  of  x  then  permits  mathematical 
simulation  of  the  ocean  vehicle  dynamic  behavior  directly  as  the  system 
in  Figure  M2.1 


-63- 


An  explicit  solution  of  equation  M2.24  is  readily  arrived  at  if 
X,  ,  is  represented  by  the  Taylor  series  of  equation  M2.7  but  with 
only  the  x  terras  which  are  linear  in  x  retained.  In  that  case  equation 
142. 7  reduces  to  equation  M2.25  with  the  coefficients  represented  by 
abbreviations  of  the  form  of  equation  M2.8,  This  series  approximation 
generally  holds  when  the  values  of  the  state  derivative  k   are  assumed 
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M2.25 
to  be  very  small,  but  the  validity  of  that  assumption  must  be  verified 
for  the  specific  vehicle  being  simulated.  The  result  of  substituting 
equation  M2.25  into  equation  M2.24  is  given  by  equation  M2.26  with  the 
definitions  in  equations  M2.2?  through  M2.29,  Thus,  for  the  cases  in 
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(a  =  added  mass)  M2.29 


which  the  matrix  A  is  of  full  rank  (det  A  /-   0),  the  state  derivative 

&  is  explicitly  solvable  by  using  the  inverse  of  A. 
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There  are  several  other  simplifications  which  can  be  made  with 
regard  to  equation  M2.26.   The  equilibrium  (0,  0)  solution  X  for 
most  ocean  vehicles  is  X  =»  0_.  This  means  that  with  no  inputs  they 
are  designed  to  stand  motionless,  and  if  they  are  moving  and  the 
inputs  "become  zero,  they  eventually  stop.   If,  however,  the  X.  , 
Taylor  series  is  expanded  about  a  point  other  than  zero  (0,  0), 
these  constant  terms  X  would  not  be  expected  to  be  zero. 

Another  simplification  to  equation  M2.26  results  from  utilizing 
the  symmetry  of  X_.  .  to  reduce  the  summations  necessary.  The  total 
mathematical  model  with  linear,  second,  and  third  degree  coefficients 
is  then  given  by  equation  M2e30.  This  equation  contains  6  states 
and  5^1  parameters,  not  counting  the  effector  parameters  or  structure. 
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The  parameters  in  equation  M2.30  consist  of  the  following: 


7  parameters  in  A  and  f_r;  m,  x1Q,  x2G,  x^,  Ix  ,  I  ,  ly 

X  C.  J 

36  added  mass  coefficients  X.      k,  i  *■  1,  6 
36  linear  coefficients  X  k,  i  *  1,  6 

126  second  degree  coefficients  X    k,  i,  j  ■  1,  6,  syra. 

33^  third  degree  coefficients  X.  .    k,  i,  j,  n  ■  1,  6,  sym. 

541  total  parameters,  not  including  effector  parameters, 
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H2 . 5  EFFECTOR  STRUCTURE  AND  PARAMETERS 

This  thesis  has  thus  far  implicitly  considered  the  effector 
forces  and  moments  to  be  that  part  of  the  hydrodynamic  structure 
excluding  the  hydrodynamic  forces  and  moments.  However,  for  a  general 
ocean  vehicle,  this  definition  becomes  even  less  precise,  and  the 
dividing  line  betvreen  effector  and  hydrodynamic  forces  is  determined 
by  the  particular  vehicle  and  by  which  portions  of  its  behavior  fit 
into  the  summations  in  equation  M2.30  and  which  don't. 

This  is  an  important  point  and  can  perhaps  be  illustrated  by  a 
brief  reference  to  the  DSRV  mathematical  model  of  Section  5  (d). 
The  primary  DSRV  effectors  are  its  movable  shroud,  thrusters,  propellor, 
and  tanks.  Since  each  of  these  directly  involves  an  input  variable, 
it  is  placed  in  the  effector  structure.  Directly  beneath  the  DSRV 
is  a  transfer  skirt  and  a  splitter  plate  immediately  aft  of  it.  The 
effects  of  these  appendages  upon  the  motion  of  the  vehicle  are  calcu- 
lated using  the  hydrodynamic  coefficients  and  so  these  are  not 
considered  to  be  part  of  the  effector  structure.  The  horizontal 
and  vertical  sidewise  (secondary)  motions  of  the  DSRV  are  modeled 
by  a  structure  (Appendix  A3)  which  does  not  fit  into  the  coefficient 
summations  of  equation  M2,30»  Therefore,  for  the  purposes  of  modeling 
using  equation  112.30,  these  forces  and  moments,  even  though  they  are 
strictly  functions  of  the  state  x  and  not  functions  of  the  inputs, 
are  considered  to  be  effectors.  Finally p  both  structural  uncertainty 
(Chapter  M^-)  and  input  disturbances  to  the  vehicle,  such  as  waves  or 
currents,  are  placed  in  the  effector  structure. 

In  general,  all  structure  which  is  functionally  dependent  upon 

the  input  variables  is  considered  effector  structure.  In  many  cases 
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the  effectors  on  ocean  vehicles  themselves  must  be  modeled  as  dynamic 
systems  with  state  variables  and  parameters.  It  may  also  be  that  for 
a  particular  vehicle,  the  effector  states  or  the  vehicle  inputs  cannot 
be  uncoupled  from  the  hydrodynamic  forces  and  moments.  In  this  case 
a  more  general  relationship  than  equation  K2.30  would  be  required 
with  structure  specifying  such  coupling  included  in  the  equation. 
As  mentioned  in  Chapter  hl.3»  the  effector  structure  must  be 
developed  for  the  specific  vehicle  or  class  of  vehicles.  For  the 
purposes  of  the  investigations  of  this  thesis,  the  effector  structure 
will  be  assumed  to  be  known  with  the  exception  of  a  finite  number  of 
parameters  p_.  The  effector  forces  and  moments  will  also  be  assumed 
to  be  time  invariant  and  to  depend  upon  the  state  x,  the  input  vector 
u,  and  the  general  parameter  vector  p_  as  in  equation  K2.31* 

*eff  =  ^eff  (-x->  H.»  E)    '  M2.31 

If  the  effectors  are  dynamic  systems  and  have  their  own  state 
variables  and  parameters,  they  should,  if  possible,  be  modeled  as 
separate  subsystems  with  only  their  input-output  relationship  apparent 
in  M2.31*  The  fact  that  for  a  particular  vehicle  the  effectors  are 
dynamic  systems  does  not  necessarily  mean  that  the  identification  of 
their  parameters  in  p_  is  impossible  or  even  that  its  identification 
is  more  difficult  than  that  for  a  vehicle  with  static  system  effectors* 
H2 , 6  SUMMARY  OF  3HES  CHAPTER 

It  is  a  fascinating  question  to  ask  oneself  what  single  equation 

can  be  written  which  will  model  the  states  of  anything  which  moves! 

(Equation  M2.2)  We  then  ask  ourselves  how  this  equation  changes  when 

we  restrict  ourselves  to  a  vehicle  which  moves  under  Newton's  Law, 
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(Equation  M2.15)  At  that  point  we  enter  the  ocean  environment  and 
begin  to  develop  a  further  reduced  state  equation.   (Equation  M2.30) 
If  ue  now  take  the  fftl  parameters  of  equa.tion  M2.30  and  include  them 
in  the  general  parameter  vector  p_,  we  can  write  a  final  state  space 
equation  which  will  model  a  large  class  of  ocean  vehicles.   (Equation 
M2*32) 


I   (x.  P_)  =  fr  (x.  2)  +  4yd  (x.  V)  K2.33 

The  next  chapter  is  a  more  extensive  discussion  of  several  of 

the  peculiarities  of  ocean  vehicle  behavior  which  in  some  cases  • 

y 

cannot  be  modeled  directly  bar  equation  M2.30.  The  concept  and  form  of 

a  measurement  function  for  the  states  of  an  ocean  vehicle  is  presented 
and  discussedc  The  fact  that  fluidic  memory  does  not  directly  fit 
equation  M2.30  is  discussed,  and  a  more  detailed  formulation  of 
several  types  of  nonlinear  behavior  is  analyzed  and  the  inclusion  of 
such  behavior  in  the  model  structure  is  considered. 
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CHAPTER  M3 

PECULIARITIES  OF  OCEAN  VEHICLE  MODELS 

There  are  some  dynamic  system  peculiarities  exhibited  by  ocean 
vehicles  which  cannot  be  modeled  directly  by  equation  M2.30  or  which 
require  further  comment  regarding  their  inclusion  into  the  general 
mod el c  Several  of  the  topics  to  be  covered  in  this  chapter  are  the 
measurement  function,  fluidlc  memory  modeling,  and  nonlinear  behavior. 
This  chapter  is  not  essential  to  the  identification  studies  of  later 
sections  of  this  thesis  but  is  included  as  an  extension  to  the  theory 
of  modeling  a  general  ocean  vehicle. 
M3.1  MEASUREMENT  FUNCTIONS 

For  the  purposes  of  the  identification  studies  in  this  thesis, 
the  deterministic  measurement  function  (Chapter  14)  for  the  general 
ocean  vehicle  has  been  assumed  to  be  given  by  equation  M3»l»   This 

z  =  x  M3.1 

assumption  is  not  valid  for  most  measurement  systems  used  on  such 
vehicles.  The  measurement  function  is  a  transformation  relationship 
which  expresses  the  system  output  quantities  z_  in  terms  of  the 
observable  or  measurable  states  x  of  the  dynamic  system  and  is  usually 
a  nonlinear  function  for  ocean  vehicle  measurements. 

Equation  M3.1  is  from  a  simulation  and  identification  standpoint 
the  simplest  measurement  function  which  could  be  used.   If  the  states 
of  an  ocean  vehicle  were  measured  by  linear  sensors  and  amplifiers, 
the  relationship  would  be  as  in  equation  M3»2,  where  the  H  matrix 
represents  the  cross  coupling  of  the  states  and  the  amplifier  gains. 
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Tiiis  type  of  measurement  function  fits  directly  into  the  existing 

z  «  Hx  M3.2 

state  space  theory  for  dynamic  systems  (S-7)  (S-3)  (D-4)  (A-6)  (H-4) 
(B-7)  (0~i),  etc. 5  and  assuming  that  the  states  are  "observable" 
(see  references) »  equation  M3.2  is  easily  incorporated  into  the 
general  model  and  into  the  identification  procedures  of  later  sec- 
tions. There  have  also  been  procedures  developed  for  linear  systems 
which  are  not  observable  (C-l). 

The  general  class  of  sensors  and  measurement  systems  used  for 
ocean  vehicles  contains  many  different  types  of  devices  (pressure, 
velocity,  and  inertial  sensors,  doppler  sensors,  meters,  computers, 
etc.)  and,  therefore,  will  be  modeled  by  many  differently  structured 
measurement  functions.  The  form  of  the  measurement  function  for  a 
general  nonlinear  system  is  given  by  equation  I'3.3«  With  this  form 

z_  -  h  (x)  M3.3 

for  the  measurement  function,  the  first  consideration  with  regard  to 
any  total  mathematical,  model  or  to  any  system  identification  must  be 
to  test  the  system  for  observabilityf  Such  tests  are  developed  or 
referenced  in  the  literature  (G~9)  (S-5)i  but  these  methods  become 
prohibitively  tedious  for  significant  nonlinearities  or  for  multiple 
degrees  of  freedom,  A  possible,  but  perhaps  expensive  and  time 
consuming,  alternative  to  this  test  is  to  assume  observability  and 
proceed  to  the  identifiability  studies  of  later  sections.   If  trouble 
is  encountered  there,  this  assumption,  along  with  many  others,  would 

have  to  be  questioned, 
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The  form  of  equation  M3»3  used  in  the  general  parametric  ident- 
ification problem  is  given  by  equation  M3«^  in  which  the  structure 
h  is  assumed  known  and  the  parameter  vector  £  is  to  be  determined  by 
identification.  The  nonlinear  observability  criteria  must  also  be 

2,  =  h  (x,  p)  M3.^ 

analyzed  for  this  equation  as  with  the  previous  equations. 

The  next  step  upward  in  generality  of  measurement  functions 
would  be  one  which  was  dependent  upon  the  input  u.  This  equation 
is  given  by  M3«5  &nd  would  be  required  whenever  the  measured  variables 
could  net  be  uncoupled  from  the  vehicle  inputs.   Equation  M3»5»  as  with 

previous  equations  of  this  chapter,  is  a  static  relationship.  If 
the  effectors  for  a  given  vehicle  are  dynamic,  having  their  own  state 
variables j  then  if  possible,  only  the  input-output  relationship 
should  feed  into  equation  M3»5« 
M3.2  HAJIDIC_  MEMORY 

The  essence  of  fluidic  memory  is  that  the  future  behavior  of  a 
vehicle  in  a  fluid  depends  not  only  upon  its  present  motions,  but  also 
upon  all  past  motions.  This  in  fact  says  that  the  general  ocean 
vehicle  is  not  a  state- determined  system  (Chapter  M2,l)  and  that 
equation  112, 5  is  incomplete  and  should  be  modified  as  in  equation  M3*6« 

X  =  X,  ,  (Motion,  Past  Motion)  +  X  f  .  (Body,  Motion, 

Past  Motion,  Fluid)  M3.6 
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The  fact  that  vehicles  moving  in  fluids  have  beer,  shown  to  depend 
upon  their  past  motion  is  pointed  out  and  referenced  by  Newman  (N-5) 
(N-6)  and  Dogan  (D-2).   The  models  which  must  be  used  for  inclusion 
of  all  past  motion  in  the  general  ocean  vehicle  simulation  would  have 
to  consist  of  partial  differential  equations  representing  the  distri- 
buted or  infitite-state  time  behavior.  It  is  expected  that  for  the 
general  case,  these  equations  would  be  extremely  difficult  to  solve. 

One  method  of  having  the  general  vehicle  mathematical  model 
take  into  account  the  past  vehicle  behavior  5s  to  increase  the  number 
of  states  x  to  include  the  present  state  and  the  past  states  at  n 
increments  of  time  into  the  past.  This  representation  implicitly 
assumes  that  the  fluidic  memory  is  finite  in  length  of  time  and  that 
it  can  be  modeled  by  n  time-samples  into  the  past  (x-,  ,  x?,  •»«,  x  ). 
This  assumption  then  allows  the  general  ocean  vehicle  with  fluidic 
memory  to  be  modeled  as  a  state  determined  system  with  n  -}-  1  times 
as  many  states  as  the  model  without  fluidic  memory. 

The  modifications  which  must  be  made  to  equation  M2«2^  to  include 
the  finite  memory  are  conceptually  straightforward  even  though  perhaps 
computationally  prohibitive.  The  first  step  is  to  define  a  new  state 

vector  x   to  include  all  of  the  present  and  past  states  as  in  equation 

"tin 

M3.7.  In  this  equation  the  variable  x  is  actually  x(t)f  where  t  is  the 
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M3.7 
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present  time  of  consideration,  and  is  the  sane  as  equation  M2J1-. 
The  "memory"  variables  are  then  spaced  at  increments  of  time  into  the 
past  (6.,  ••«,  6  )  and  the  variables  axe  the  vehicle  velocities 
evaluated  at  those  times  Qc  (t-6  ),  .»<>,  x  (t  -  6  )]. 

The  matrix  A  and  vector,  f  (x)  in  equation  112.2^-  are  independent 
of  the  memory  effects  and  are  thus  merely  repeated  cind  evaluated  at 
the  past  times  to  form  the  matrix  A   and  vector  f^  given  in  equa~ 


fm 


-im 


tions  M3«8  and  M3»9*  The   terms  X,  ,  and  X  „„  represent  the  coupling 
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of  the  past  states  into  the  present  as  well  as  representing  the 

present  behavior  of  the  vehicle.  These  new  functions  are  designated 

here  as  Xfm>hyd  (xfm,  xfJ  and  X^^  (x^,  u^,  £>.  If  the  effecto; 

parameters  p_  were  time  varying,  then  a  fluidic  memory  version  p~ 

would  have  to  be  included  in  X„   «„,  The  combination  of  these 

-^fntfeif 

results  permits  the  total  mathematical  model  including  fluidic  memory 
to  be  written  as  equation  M3.10. 


Afm  2.fm  "  £fm,hyd  ^fm»  ^£rr)   "  -fm  fefj  +  -fm.eff  ^m»  -fm»  ^ 


fm  x-fm'   -rfra.eff  v-^fm'  -fm' 

M3.10 
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The  same  considerations  now  apply  to  equation  M3*10  as  previously- 
applied  to  equation  M2.24  except  some  of  the  very  beneficial  symmetry 
reductions  in  the  latter  equation  cannot  be  applied  to  the  Taylor 
series  expansion  of  the  former.   The  finite  fluidic  memory  version  of 
equation  M2.30  without  taking  into  account  any  possible  symmetry  is 
given  here  as  equation  M3.H.   The  fluidic  memory  A  matrix  is  defined 
the  same  as  in  equations  M2.2?  through  M2.29  except  that  the  indices 

run  as  i,  j  =  1,  6  (n  -{-  l)t  and  the  X-  .  ,  terms  are  differentiated. 

".-■.•     f  m  ,  hyd 

The  summations  run  over  all  of  the  finite  memory  states,  and  the  number 

of  these  is  given  by  equation  M3.12.   The  fluidic  memory  A  matrix  is 

square  and  of  dimension  n„  *  n.,  . 

fm    fm 


-^fm       — fm  v-fm/       — fm,eff  v— rnr   -fm'   ** 

nfm                                nfm  nfm 

\^  rffc.i  Xfrn.ti  +  ^  \^  Sfn.ij  *fn(i  xffflf j  + 

"fm  "fm  "f ra  „ 

E       )        Y.       X               x           x           x 

n»l  j-1  i»l  -fm,ijn     fm,i     fm, j     fra.n                M3.ll 

n~  =  6  (n  +  l)        where  n  =  number  of  past  times 

in  memory 

M3.12 


Solving  equation  M3«ll  for  many  past  times  is  prohibitive  from 
a  computation-time  standpoint.  However,  it  is  felt  that  the  complex- 
ity of  equation  M3«ll  can  be  very  significantly  reduced  by  incorpor- 
ating the  specific  characteristics  of  a  given  ocean  vehicle  to  eliminate 
a  large  percentage  of  the  terms  and  coefficients  and  still  successfully 
model  the  vehicle  including  memory  effects.   The  point  to  be  made  here 

is  that  fluidic  memory  seldom  need  apply  to  all  past  times  in  all  past 
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degrees  of  freedom  but  in  general  is  only  significant  in  one  or  two 
degrees  of  freedom*  The  study  of  these  limitations  and  the  utiliza- 
tion of  equation  M3<-11  represent  extremely  profitable  potential  areas 
for  breakthroughs  in  ocean  vehicle  mathematical  modeling.   These 
vehicle  limitations  combined  with  symmetry  reductions  would  reduce 
equation  M3»H  to  a  computationally  solvable  system  which  could  then 
be  utilized  in  the  identification  equations  and  methods  of  later 
sections  of  this  thesis. 
M3. 3  NONLINEAR  BEHAVIOR 

There  are  several  instances  in  which  the  structure  of  equations 
M2.30  and  M3.ll  may  need  to  be  modified  to  take  into  account  some 
very  obvious  nonlinearities  in  ocean  vehicle  behavior.  Several  of 
the  considerations  necessary  to  make  these  modifications  are  given 
by  Abkowitz  (A-ll)  (A~l)  and  Mandel, (C-4,  p.  544).  The  modifications 
are  described  and  illustrated  in  the  below  examples,  but  the  basic 
aim  of  structural  modifications  is  to  minimize  the  number  of  coeffi- 
cients or  parameters  which  must  be  evaluated.  The  equation  structure 
is  by  far  the  most  important  part  of  the  mathematical  model;  and  if 
variations  in  the  basic  Taylor  series  form  gives  closer  data  fit  with 
fewer  parameters,  then  the  structure  should  be  modified  to  include 
those  variations. 

As  a  first  example  let  us  consider  the  hydrodynamic  drag  force  X 
exerted  upon  an  object  being  pulled  through  a  fluid  with  a  constant 
velocity  u.   Suppose  that  a  drag  coefficient  X   can  then  be  defined 
for  the  object  as  in  equation  M3«13»   If  X   has  been  shown  to  be 

X  -  Xuu  u3  M3.13 


constant  for  the  given  object,  then  X   corresponds  perfectly  to  X-,-, 
in  equation  M2.30.  Now  consider  that  the  same  object  is  being  pulled 
in  the  opposite  direction  with  a  constant  velocity  u,  where  u  is 
negative.  In  this  case  equation  K3.13  is  no  longer  structurally 
valid  because  we  know  that  a  negative  force  must  be  required. 

There  are  at  least  three  possible  ways  to  remedy  this  mathemat- 
ical structure  discrepancy:  a  larger  number  of  Taylor  series  terms, 

foreward  and  reverse  values  for  X  ,  or  adoption  of  an  absolute 

uu'      r 

square  law  structure.   The  objective  here  is  to  have  a  structure 
which  corresponds  as  closely  as  possible  to  the  behavior  of  the 
object,  but  it  is  also  desirable  to  have  the  smallest  number  of 
parameters  if  these  parameters  are  to  be  identified  using  the  pro- 
cedures of  this  thesis.   If  we  plot  the  behavior  of  the  object,  we 
get  the  curve  given  in  Figure  M3«l» 


Figure  K3.1  ABSOLUTE  SQUARE  LAW  DRAG 
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Given  a  desired  measure  of  accuracy  which  the  model  structure 
must  have  in  order  to  be  said  to  represent  the  behavior  of  the  object, 
then  certainly  if  enough  odd  degree  terms  in  the  T3.ylor  scries  are 
utilized,  the  behavior  of  the  object  can  be  modeled.   This  structure, 
however  accurate,  must  contain  more  parameters  than  simply  X   and 
would  therefore  be  a  much  more  costly  model  in  terms  of  later  effort 
in  identifying  those  parameters.  All  of  this  is,  of  course,  for  the 
case  in  which  the  above  data  plot  is  considered  to  be  structurally 
proper,  but  numerically  inaccurate,  or  in  other  words,  is  noisy. 

Another  way  to  take  care  of  the  reverse  behavior  in  Figure  M3.1 

is  to  simply  state  that  X   has  one  value  for  the  foreward  mode 

r  J  uu 

(namely  X  )  and  another  value  for  the  reverse  mode  (namely  "X  ). 
uu  uu 

This  in  effect  gives  two  separate  mathematical  models  for  two  separate 
regions  of  the  object  and  requires  two  parameters  for  the  complete 
model.  There  are  several  difficulties  encountered  with  this  repre- 
sentation used  in  the  parametric  identification  procedures  of  later 
sections.  First  of  all  the  regions  of  operation  must  be  strictly 
observed  for  the  specific  model  used.   Secondly  there  are  twice  as 
many  parameters  to  identify.  Finally r  when  Kalman  filtering  is  used 
and  X   is  considered  a  state  variable,  it  must  be  modeled  as  a  highly 
discontinuous  function. 

The  best  way  to  model  the  object  behavior  in  Figure  M3°l  is  by 
recognizing  that  the  basic  curve  shape  is  absolute  square.  This  then 

permits  the  model  to  be  written  as  equations  M3.1^  and  M3«15  and 

1 
requires  only  one  parameter.   This  term  would  then  replace  the  X-,-, 

term  in  the  Taylor  series  model  of  equation  M2„30»  and  its  inclusion 

there  would  most  likely  contribute  to  the  overall  model  parameter 
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identifiability  from  noisy  data, 

X  =  Xu(ul  u|u|  M3.14 

x  .  .  »  x  M3#l5 

u|u(  uu 

Another  specific  instance  in  which  structure  has  been  developed 
which  does  not  fit  into  equation  M2.30  is  with  regard  to  the  secondary 
or  cross  flow  drag  equations  for  the  DSRV  (Appendix  A3).  These 
equations  are  appended  as  effector  functions  end  the  corresponding 
terms  in  the  Taylor  series  are  deleted  because  the  analysis  of  pre- 
liminary experimental  and  theoretical  data  resulted  in  a  structure 
which  did  not  fit  directly  into  the  series. 

It  is  hoped  that  these  examples  may  serve  to  point  out  the 
importance  of  proper  model  structure  in  later  parameter  identifiability 
studies  and  identifications.  The  lesson  to  be  learned  is  that  when- 
ever a  choice  must  be  made  between  Taylor  series  terms  and  a  different 
structural  form  resulting  from  preliminary  investigations,  the  latter 
should  always  be  included  in  the  model. 

This  chapter  has  presented  some  extension  and  modification 

ideas  which  in  some  cases  must  be  applied  to  the  general  mathematical 

laodels  of  Chapter  M3  in  order  to  properly  simulate  the  vehicle  or  in 

order  to  be  able  to  identify  parameters  using  the  techniques  of  this 

thesis.  The  first  of  these  was  the  concept  of  a  general  nonlinear 

measurement  function  whose  structure  must  be  determined  for  a  specific 

vehicle  and  whose  parameters  may  need  to  be  identified.  Next  the 

general  ocean  vehicle  mathematical  model  was  modified  to  include  the 

effects  of  fluldic  memory  by  assuming  that  the  memory  was  finite  and 

-78- 


that  it  could  be  represented  by  n  past  samples  of  the  vehicle  states, 
Finally,  the  general  model  was  also  modified  to  include  significant 
structural  nonlinearities  which  were  not  consistent  with  the  Taylor 
series  representation.  The  next  chapter  presents  the  modifications 
to  the  total  mathematical  model  necessary  to  include  the  effects  of 
uncertain  structure,  both  in  the  basic  vehicle  equation  and  in  the 
measurement  function, 
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CHAPTER  M 

OCEAN  VEHICLE  MODELS  WITH  UNCERTAIN  STRUCTURE] 

The  primary  purpose  of  this  chapter  is  to  include  in  the  general 
ocean  vehicle  dynamic  mathematical  model  the  fact  that  at  this  time 
neither  theoretical  nor  experimental  analysis  can  completely  or  per- 
fectly determine  the  structure  of  the  vehicle  equations  or  of  the 
measurement  function.  This  fact  introduces  into  the  general  model 
two  forms  of  "uncertainty"  or  noise:  process  noise  w  and  measurement 
noise  v.  In  both  cases  these  uncertainties  are  modeled  as  stochastic 
processes  (P~3)  (S~6)  (A~5)  (B-8)  (B=?)  (C~3)  (J-6)   (L~6)  (M-2)  (R-'O 
(S-3)  etc* j  and  then  these  terms  are  included  as  random  variables  in 
the  mathematical  model  used  for  simulating  the  real,  vehicle.  The 
deterministic  version  (without  w  and  v)  is  used  as  the  model  to  be 
varied  in  the  identification  procedures  of  later  sections,  and  the 
stochastic  version  (with  w  and  v)  is  used  in  the  sea  trial  data 
generation  or  real  vehicle  simulation. 

The  total  ocean  vehicle  mathematical  model  may  be  summarised 
here  by  repeating  equations  M2„32  and  M3»5  as  equations  M'+.l  and  V\k,2, 


Ocean  Vehicle  Dynamic-  Mathematical  Model 

a(e)  k  -  £  (*•  e)  +  £eff  &  H»  e)  m.i 

s  =  h  (x,  u,  p_)  M4.2 


Tnis  set  of  equations  is  a  deterministic  system  of  differential 
equations  which  contains  in  some  sense  all  that  is  known  about  the 

dynamic  behavior  of  an  ocean  vehicle.  If,  at  this  point,  it  is 
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desirable  to  also  model  the  unknown  aspects  of  the  vehicle  behavior 
by  two  stochastic  processes  w  and  v,  then  the  model  becomes  non- 
deterministic  and  is  represented  by  equations  M^.3  and  M*f,4.  If 


Ocean  Vehicle  Stochastic  Mathematical  Model 

a(e)  k  -  £  (*»  £)  +  leff  (&  li»  P..  ]i)  M>t.3 

z  =  h  (x,  u,  p_,  v)  MA 


the  very  strong  assumption  is  then  made  that  these  noise  processes 
are  coupled  linearly  into  the  dynamics  of  the  vehicle,  then  the 
equations  M^. 5  and  M^.6  result.  The  validity  of  this  assumption 
would  have  to  be  determined  for  any  ocean  vehicle  under  considera- 
tion by  theoretical,  experimental  or  identification  studies. 


Ocean  Vehicle  Stochastic  Model  With  Linear  Noises 

Me)  k  -  1  (*»  e)  +  £eff  (*»  'h.  e)  +  G  jl  M/+«5 

z  =  h  (x,  u,  p_)  +  v  K^,6 


In  both  cases  the  noise  vectors  w  and  v  may  be  considered  to  be 
models  for  structural  uncertainty  or  models  for  input  function 
uncertainty.  In  equation  Yfo, 5  the  noise  vector  w  may  represent  a 
stochastic  model  of  the  remaining  terms  in  the  Taylor  series  expan- 
sion of  f  which  were  not  included (  or  it  may  represent  a  model  for 

the  unknown  aspects  of  the  effector  function  f  __  structure,  In 

— erf 
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addition  w  may  model  unknown  aspects  of  the  input  vector  u  (K-6, 

p.  166)  or  noise  in  the  measurement  system  for  determining  u  for  the 

vehicle.   Likewise,  v  may  model  the  structural  uncertainty  of  h  or 

the  noise  in  the  input  vector  u.   In  both  causes  the  noise  inputs 

change  the  equations  from  a  time  invariant  to  a  time  varying  system. 

For  the  purposes  of  the  identification  studies  in  this  thesis, 

the  noise  vectors  w  and  v  v»ill  be  assumed  to  be  uncorrelated,  discrete, 

— n     -n  '        ' 

zero-mean,  gaussian  white  noise  processes  described  by  equations  E^,7 
through  M^.10.   This  is  done  in  some  instances  to  simplify  the  tech- 
niques and  in  other  instances  to  simplify  the  computations.   Further 

w  =  E[w]  =  v=E[v]  =  Oawn  =  vn-  iM^I.7 

eC*^)  wT(t-f-t)]  -  Q>  6(t)   ;   Q~  C^6t  for  discrete  w^  M4.8 

E[v(t)  vT(t+-y)]  -  Rc  6(T)   ;  R  «  Rc/ot  for  discrete  yn  M^.9 

E[wvT]  m   [0]  M4.10 

studies  can  now  be  made  using  the  techniques  of  this  thesis  and 
relaxing  these  assumptions  through  procedures  in  the  literature  to 
determine  structure  and  identifiability  for  specific  ocean  vehicles. 
As  previously  mentioned,  the  measurement  function  to  be  used  in 
the  analysis  in  this  thesis  is  an  identity  between  states  and  measure- 
ments plus  linear  noise.   In  addition,  the  process  noise  coupling 
matrix  G  is  assumed  to  be  the  identity  matrix.   These  two  assumptions 
result  in  the  model  given  by  equations  M^-.ll  and  M4.12  and  the  system 
diagram  given  in  Figure  M^-.l.   Future  studies  should  be  made  on  the 
general  vehicle  model  without  these  two  assumptions  to  determine 
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their  effect  upon  identifiability  of  parameters  using  the  techniques 
of  this  thesis. 


Specialized  Ocean  Vehicle  Stochastic  Model 


A(£)  k  *  f  (X,  £)  +  f  -p  (X,  U,  p_)  +  K 


^ff 


Z  *  X  +  V 


H4.ll 


M^.12 


-o 


u 


u 


1 


*£eff(*iii,]>) 


4?IE 


£(*.  2) 


-1 


a(p_)-^H/; 


,,-~0 


v, 


X  * 


-oz 


Figure  M^.l  SYSTEM  DIAGRAM  OF.A  GENERAL  OCEAN  VEHICLE 
MATHEMATICAL  MODEL  WITH  NOISE " INPUTS 


This  chapter  has  presented  the  hierarchy  of  models  which  result 
from  the  inclusion  of  stochastic  processes  w  and  v  to  model  structural 
uncertainty  or  input  noise.  These  stochastic  models  are  to  be  used 
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in  this  thesis  for  simulating  the  real  ocean  vehicle  in  a  "noisy" 
environment.  Their  deterministic  versions  with  variable  parameters 
will  then  be  used  to  process  the  data  and  identify  the  parameters. 

This  section  has  presented  or  referenced  the  complete  develop- 
ment of  general  mathematical  models  for  the  dynamic  behavior  of  ocean 
vehicles.  These  models  have  been  presented  in  a  hierarchial  manner 
starting  with  the  most  general  versions  and  then  proceeding  to  the 
simpler  versions  by  making  assumptions  with  regard  to  the  vehicle 
behavior.  The  models  have  been  developed  using  a  state  space  format 
to  simplify  writing  them  down  and  to  simplify  their  computation. 
Several  extensions  to  the  general  models  in  the  form  of  measurement 
functions,  fluidic  memory,  nonlinearities,  and  uncertain  structure 
have  been  discussed  and  their  equations  presented.  The  next  section 
presents  the  identification  equations  which  are  to  be  applied  to  these 
models  and  the  simulated  noisy  data  to  evaluate  the  vehicle  parameter 
vector  p_  and  to  determine  its  identif lability. 
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SECTION  3 

PARAMETRIC  IDENTIFICATION  OF  NONLINEAR  STOCHASTIC  SYSTEMS  (n) 

Nl   DEFINITION  OF  PARAMETRIC  IDENTIFICATION 

N2   MODEL  REFERENCE  IDENTIFICATION 

N3   EXTENDED  KALMAN  FILTERING 

N^   STUDYING  IDENTIFIABILITY  OF  PARAMETERS 


PERHAPS  CONCERNING  IDENTIFICATION: 

" ON  A  HIGH  HILL 

RAGGED  AND  STEEP,  TRUTH  DWELLS,  AND  HE  THAT  WILL 

REACH  HER,  ABOUT  MUST,  AND  ABOUT  MUST  GO; 

AND  WHAT  Yd*   HILL'S  SUDDENNESS  RESISTS,  WIN  SO." 


JOHN  DONNE,  SATIRE  III  OF  RELIGION 

(1590) 


THIS  THESIS  IS  PRIMARILY  CONCERNED  WITH  APPLYING  MODEL  REFERENCE  AND 
EXTENDED  KALMAN  FILTERING  IDENTIFICATION  TECHNIQUES  TO  DYNAMIC 
MATHEMATICAL  MODELS  OF  OCEAN  VEHICLE  MOTIONS ,  WITH  THE  DSRV  AS  AN 
EXAMPLE.   THE  LAST  SECTION  DEVELOPED  GENERAL  STATE  SPACE  OCEAN  VEHICLE 
MODELS  AND  EXPLAINED  THEIR  LIMITATIONS  AND  POSSIBLE  EXTENSIONS.   THIS 
SECTION  PRESENTS  THE  BASIC  EQUATIONS  FOR  THE  TWO  IDENTIFICATION 
TECHNIQUES  AND  EXPLAINS  HOW  THEY  ARE  USED.   THE  NEXT  SECTION  THEN 
COMBINES  THE  GENERAL  MODEL  EQUATIONS  AND  THE  IDENTIFICATION  EQUATIONS 
AND  SHOWS  IN  DEPTH  HOW  THEY  APPLY  TO  SEVERAL  SIMPLE  EXAMPLE  DSRV 
EQUATIONS. 
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CHAPTER  Nl 

DEFINITION  OF. PARAMETRIC  IDENTIFICATION 

The  purpose  of  this  section  is  to  present  and  discuss  the  equa- 
tions for  the  general  problem  of  identifying  parameters  in  a  nonlinear 
dynamic  system  using  model  reference  and  extended  Kalman  filtering 
techniques.  To  begin  with,  this  chapter  defines  parametric  identif- 
ication for  general  and  for  more  specialized  cases  and  cites  some  of 
the  literature  applicable  to  these  problems,,  The  next  two  chapters 
then  describe  the  two  techniques  to  be  utilized  in  this  thesis  to 
study  the  DSRV  coefficients  and  parameters:  model  reference  contouring 
and  extended  Kalman  filterings  Finally,  the  last  chapter  presents  a 
general  discussion  of  the  considerations  and  steps  involved  in 
determining  quantitatively  whether  or  not  a  given  parameter  is 
identifiable  for  a  given  vehicle  and  given  type  of  maneuver. 
Nl . 1  INTRODUCTION  TO PARAMETRIC  IDENTIFICATION 

In  Section  2  (m)  the  process  of  understanding  the  dynamic  behavior 
of  ocean  vehicles  using  mathematical  modeling  was  discussed.  In  this 
section  the  details  of  a  group  of  techniques  for  determining  certain 
unknown  portions  of  those  mathematical  models  from  either  full-scale 
or  physical  model  data  are  presented,  These  techniques  operate  on 
mathematical  models  which  are  known  except  for  the  n  -  constants  in 
a  parameter  vector  £  and  on  noisy  data  from  a  real,  vehicle  or  a 
simulated  vehicle.  The  goal  is  then  to  determine  a  proper  value  of 
£  and  thereby  complete  the  specification  of  the  mathematical  model. 

The  theory  of  parametric  identification  is  by  no  means  the  only 

way  to  attack  this  problem.  The  history  and  literature  of  ocean 
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engineering  are  replete  with  valuable,  practical,  and  proven  tech- 
niques for  modeling  ocean  vehicle  dynamic  motions.  This  thesis  is 
proposing  another  set  of  techniques;  however,  this  set  of  techniques 
is  shown  to  be  applicable  to  completely  general,  nonlinear,  six- 
degree-of -freedom,  noisy  mathematical  models  with  large  numbers  of 
undetermined  parameters.  These  techniques  have  been  proven  extremely 
valuable  and  workable  in  aircraft,  spacecraft,  electrical  and  mech- 
anical systems,  economic  systems,  chemical  processing  systems,  social 
systems,  and  many  others.  The  combination  of  the  present  and  past 
techniques  from  ocean  engineering  with  the  present  and  past  techniques 
from  modern  control  theory  offers  substantial  breakthroughs— theoretical , 
experimental,  and  practical— in  the  area  of  ocean  vehicle  mathematical 
modeling, 
N1.2  THE  GENERAL  PARAMETRIC  IDENTIFICATION  PROBLEM    .  , 

Parametric  identification  is  the  determination  of  a  set  of 
parameters  or  coefficients  of  a  dynamic  system  mathematical  model  of 
known  structure  using  measurements  of  the  actual  system's  dynamic 
behavior  with  the  ultimate  aim  of  having  the  model  be  the  mathematical 
equivalent  of  the  system.  This  chapter  describes  the  general  parametric 
identification  problem  for  a  nonlinear,  state-determined  dynamic  system 
with  noise  and  then  specializes  this  problem  to  the  point  at  which  it 
can  be  shown  to  include  the  models  of  Section  2  (tl). 

The  general,  nonlinear  stochastic  para.metric  identification 

problem  is  defined  by  equations  Nl.l,  N1.2,  and  Nl„3  in  Figure  Nl.l. 

A  block  diagram  of  the  dynaMc  system  equations  Nl.l  and  N1.2  is  shown 

in  Figure  N1.2  (G-6)  (C-2)  (S-3)  (h-6)    (S-6)  etc.   This  parametric 

identification  problem  has  no  completely  general,  solution.  Any 

-87- 


Given: 

State  Equation 

x  -  f  (x,  Uf  £,  w,  t)  Nl.l 

Where : 

x  =  state  vector  (n  *  l)i  x  (t  )  known 

u  «  control  vector  (n  *  l);  u  (t)  known 

j)  »  parameter  vector  (n  *  l);  v  ■  g  (p_)f  £  (t  )  known 

w  »  process  noise  vector  (r  *  l) 

t  bs  time  scalar;  t  knovm 
—  o 

f  a  system  structure  vector  (n  *  l);  known 
Measurement  Equation 

£  =  h  (*.•  H.»  £.»  Y-»  "0  N1.2 

Where : 

z  =  measurement  vector  (k  *  l);  z  (t)  known 
v  t3   measurement  noise  vector  ( j  *  l) 
h  =3  measurement  structure  vector  (k  *  l);  known 
Cost  Functional 

C  «  C  (z,  zj   ;  C  >  0  N1.3 

Where : 

C  =  scalar  cost  functional  representing  a  measure  of 
closeness  between  the  system  output  z_  and  the  mathe- 


matical model  output  z  j  known  structure;  C  >  0 

-m  — 


Using: 


u  (t),  z  (t),  f,  g_,  h,  x  (t  ),  p_  (t  ),  t  ,  C 

—  **■  —  »-   o    *~   o     o 

Find: 

p_  (t)  to  minimize  C  (or  to  maximize  -C) 
Figure  Nl.l  THE  GENERAL  PARAMETRIC  IDENTIFICATION  PROBLEM 
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solution  techniques  to  be  applied  to  problems  of  this  nature  must 
in  general  be  tailored  to  the  positive  semidefinite  cost  functional 
and  to  the  specific  types  of  structural  nonlinearities.  In  many 
cases  the  properties  of  the  specific  nonlinear  system  must  be  used  to 
reduce  the  complexity  or  generality  of  equations  Nl.l,  N1.2,  and  N1.3 
to  facilitate  identification. 
Nl . 3  THE  OCEAN  VEHICLE  PARAMETRIC  IDENTIFICATION  PROBLEM 

The  specialized  ocean  vehicle  stochastic  model  which  was  pre- 
sented as  equations  M4.ll  and  M4.12  in  Section  2  (m)  can  be  seen  to 
be  a  sub-case  of  equations  Nl.l  and  N1.2  in  this  chapter.  The 
assumptions  which  must  be  made  on  equations  Nl.l,  N1.2,  and  N1.3  to 
reduce  them  in  generality  to  the  level  of  equations  M4-.ll  and  M'-!-,12 


u 


w 


x(t  ) 
— v  o' 


s 

t 


-t*  £ 


u 


Figure  ML. 2  PARAMETRIC  STOCHASTIC  DYNAMIC  SYSTEM  BLOCK  DIAGRAM 


with  a  weighted  quadratic  cost  functional  are  listed  below.   The  weighted 
quadratic  cost  functional  is  designed  to  be  a  general  distance  measure 
between  the  model  z^  and  the  system  z  for  a  given  maneuver  and  set  of 
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1.  Model  structure  and  measurement  structure  are  time  invariant. 

2.  Mode],  and  measurement  noises  are  linear  and  enter  the  system 
directly. 

3.  The  structure  of  the. measurement  function  h  is  simply  the 
vehicle  states  x  with  linear  measurement  noise. 

4.  The  cost  functional  is  a  weighted  integral  of  the  square  of 
the  difference  between  the  model  and  the  system. 

5.  The  parameters  are  not  states  but  are  constants  to  be  evaluated, 


model  parameters.   These  assumptions  reduce  the  general  parametric 
identification  problem  of  Figures  Nl.l  and  N1.2  to  the  ocean  vehicle 
parametric  identification  problem  of  Figure  N1.3  and  Figure  M4.1. 
It  is  this  latter  problem  with  only  the  second  degree  coefficients 
and  with  the  DSRV  values  and  effectors  which  will  be  investigated  in 
detail  in  Section  k   (P)  and  6  (C)  of  this  thesis. 

Much  of  the  applicable  literature  (see  Chapter  Bl)  is  devoted  to 
the  linear  state  estimation  problem  (Chapter  N3)  which  results  when 
the  parameter  vector  p_  in  Figure  N1.3  is  "augmented"  or  "stacked"  into 
the  general  state  vector  x.  A  great  many  results  are  available  with 
regard  to  the  solution  of  the  linear  state  estimation  problem  (A~2) 
(A-6)  (A-8)  (B-5)  (B-8)  (D-l)  (D-4)  (E-l)  (P-2)  (H-3)  (J-l  to  5) 
(M-4)  (M-5)  (N-l)  (R-5)  (H-7)  (S-3)  (S-6)  (s-7)  (T-2)  etc.,  but 
these  results  do  not  in  general  apply  to  the  nonlinear  models  which 
must  be  used  for  ocean  vehicle  behavior.  Instead,  they  give  a  very 
specialized  and  often  incomplete  picture  of  the  actual  nonlinear 
behavior  involved. 
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Given ; 

State  Equation 

x  ■  f  (x,  u,  jd)  +  w  Nl.*l 

Where : 

in  equation  M4,ll 
w  «s  A(pJ  w  in  equation  M^.ll 
k  -  0  I  £  -  0 
Measurement  Equation 

z  =  x  +  v  N1.5 

Cost  Functional 

t         T  -1 
C  =  /  f  (z  -  z  )  R   (z  -  z  )  dt  N1.6 


C  »  C  (u,  j>)   ;  C  >  0'  ;  R  =  Weighting  Matrix 


Using: 


S  (t),  Z    (t),  f,  X  (to),  £  (to),  t  ,  C 

Find: 

£  to  minimize  C 

Figure  N1.3  THE  OCEAN  VEHICLE  PARAMETRIC  IDENTIFICATION  PROBLEM 


As  mentioned  previously,  there  are  no  general  methods  with  which 

to  solve  nonlinear  stochastic  parametric  identification  problems.  The 

"best  that  can  usually  "be  done  is  to  take  a  proven  method  for  linear 

systems  and  extend  it  in  some  manner  to  cover  the  specific  nonlinear 

system  of  interest.  If  the  extension  can  then  be  shown  to  be  valid  in 

some  manner,  then  it  can  indeed  be  useful  for  that  specific  nonlinear 

system. 
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This  chapter  has  presented  both  a  general  and  a  more  specific 
definition  of  the  problem  of  identifying  parameters  in  a  nonlinear 
stochastic  dynamic  system*  The  assumptions  leading  from  the  general 
to  the  specific  versions  have  been  presented,  and  the  ocean  vehicle 
stochastic  model  of  Chapter  l\k   has  been  shov/n  to  be  equivalent  to  the 
specific  model  equations  Ml, 4  and  N1.5.   The  next  chapter  presents 
one  solution  technique,  namely  model  reference  contouring,  vrhich  is 
applicable  to  the  ocean  vehicle  parametric  identification  problem  of 
Figure  N1.3. 
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CHAPTER  N2 

MODEL  REFERENCE  IDENTIFICATION 

The  problem  of  finding  a  set  of  numbers  or  parameters  p_  in  a 

mathematical  model  in  such  a  way  that  the  same  input  u  to  the  system 

and  to  the  mathematical  model  produces  the  same  output  z  from  both 

has  been  defined  in  Chapter  Nl  as  parametric  identification.  This 

chapter  describes  what  might  be  considered  the  most  "obvious"  or  the 

"brute  force"  method  for  attacking  this  very  general  problem,  model 

reference  identification.  As  a  general  procedure,  model  reference 

identification  runs  the  model,  with  the  same  inputs  as  to  the  system, 

for  a  large  number  of  different  parameter  vectors  p_  and  then  selects 

the  specific  p  which  results  in  the  model  output  z  which  is  "closest" 

-~m 

to  the  original  system  output  z.     This  technique  is  described  here  by 
first  listing  its  detailed  computational  steps,  then  by  discussing 
the  problems  and  possible  variations  of  each,  and  finally  by  describing 
cost  function  contouring,  the  specific  variation  to  be  used  in  this 
thesis. 

It  is  not  intended  that  an  extensive  presentation  of  model 
reference  identification  be  given  in  this  chapter.  This  chapter 
presents,  as  a  background,  the  specific  configuration  and  computation 
steps  necessary  to  understand  the  general  utilization  of  the  method 
and  the  specific  computations  and  studies  employed  in  this  thesis. 
The  literature  (Chapter  Bl)  abounds  with  other  variations  of  the  model 
reference  approach  to  parametric  identification,  many  of  which  offer 
promise  for  application  to  ocean  vehicle  studies. 
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N2.1  MODEL  REFERENCE  CONFIGURATION 

One  "basic  configuration  for  the  model  reference  identification 
technique  is  shown  in  Figure  N2.1.   In  this  configuration  the  SYSTEM 
may  be  the  input-output  data  from  one  of  the  following:  a  noisy 
full-scale  sea  trial,  a  noisy  scale-model  towing  tank  or  self- 
propelled  test,  or,  as  in  this  thesis,  a  simulated  ocean  vehicle  using 
Figure  M^.l  and  equations  Nl.'l  and  Nle5  with  a  fixed  set  of  parameters 
p_.   The  most  general  version  of  the  SYSTEM  is  given  by  equations  Hl.l 
and  N1.2  and  Figure  N1.2, 


1 

9         \ 

V 

z 

System 

zm 

i 

r 

Cost 
Function 

u 

C(u,£) 

v 

Model 

i 

i 

Decision  and 
Modification 

£o 

4 

Figure  N2.1  MODEL  REFERENCE  CONFIGURATION 


The  MODEL  in  Figure  N2.1  is  generally  the  expected  equations  of 
motion  of  the  vehicle,  without  noise.  The  general  MODEL  is  given  by 
equations  Nl.l  and  N1.2  with  v  and  w  set  to  zero.  The  modeling  process 
is,  in  that  case,  the  fitting  of  a  deterministic  structure  to  a  noisy 
system.  The  specialized  MODEL  used  in  this  thesis  is  given  by 

-94- 


equations  N1.4  and  N1.5  with  v  »  0  and  w  =  0 .   The  COST  FUNCTION  is 
given  by  equation  Ml. 6  for  the  integral  error-squared  case  and  is 
computed  or  incremented  at  each  time  step  of  the  model  and  system 
outputs. 

The  DECISION  AND  MODIFICATION  block  in  Figure  N2.1  takes  the 
present  and  past  values  of  C  (u,  pj  and  calculates  a  new  value  of 
the  model  parameter  vector  p_.  There  are  many  algorithms  which  may 
be  used  for  determining  the  new  value  of  p_  (B-7)  (B-l)  (R-3.2)  etc., 
and  the  specific  algorithm  used  determines  to  a  great  extent  the 
characteristics  and  value  of  the  model  reference  method  for  a.  partic- 
ular system.  For  a  given  input  function  u,  the  cost  function  becomes 
solely  a  function  of  the  parameter  vector  p_.  In  this  case  the 
"optimum"  or  the  "identified"  value  or  values  of  p_  are  those  which 
minimize  C  (pj. 
N2.2  MODEL  REFERENCE  COMPUTATION  STEPS 

Now  that  the  basic  configuration  of  model  reference  identifi- 
cation in  Figure  N2.1  has  been  explained,  the  detailed  computation 
steps  involved  can  be  presented  as  Steps  N2.1  through  N2.5»  The  first 
step  in  this  method  of  parametric  identification  is  to  collect  the 
data  from  the  system  to  be  modeled.  In  the  case  of  an  ocean  vehicle 
this  step  would  be  a  full-scale  sea  trial  with  a  set  of  maneuvers  u 
and  a  set  of  measurements  of  the  vehicle  behavior  %,     In  the  case  of 
a  physical  model  this  would  be  an  experiment  in  a  towing  tank  with 
data  recordings  of  the  vehicle  inputs  u  and  the  vehicle  responses  z. 
In  the  case  of  a  simulated  ocean  vehicle,  as  in  this  thesis,  step  N2.1 
would  be  the  computed  solution  to  equations  N1.*J-  and  N1.5  for  a  fixed, 
assumed,  predetermined,  or  starting  set  of  parameters  p_.   In  all  of 
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Model  Reference  Computation  Steps 

Step  N2.1   Collect  or  generate  noisy  data  z  and  inputs  u 


u 


v 


System 


>   z 


Step  N2.2   Using  the  inputs  u  run  the  model  for  a  fixed  set 
of  parameters  p_ 


u 


Model 


— m 


Step  N2.3   Calculate  the  cost  function  C  (p_) 


t>C(p_) 


Step  N2.4   Calculate  a  new  value  of  p_  by  some  decision  and 

modification  algorithm 
•Step  N2.5   Branch  to  Step  N2.2  and  continue  until  complete  or 

until  C  (p)  is  minimum 


these  cases  the  data  which  results  is  the  time  history,  either  contin- 
uous or  discrete,  of  the  inputs  u  and  outputs  z   of  the  system. 

Once  the  data  in  step  N2el  has  been  collected,  the  process  of 
analyzing  it  to  determine  the  model  parameters  can  begin.   The  ident- 
ification procedure  may  be  an  on-line,  real-time  process  in  which  an 

on-board  computer  calculates  and  updates  the  parameters  at  each  system 
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time  increment.   If  this  is  the  case,  the  identification  computations 

must  be  completed  between  the  process  time  steps,  which  may  require 

a  fast  computer  or  general  model  simplifications.   The  identification 

procedure  may  also  be  an  off-line  or  non-real-time  process  in  which 

the  data  is  collected  during  the  running  of  the  system,  and  then 

processed  at  a  later  time.  The  off-line  process  is  more  realistic 

for  ocean  vehicle  identification  applications  and  is  the  one  to  be 

utilized  in  this  thesis. 

The  computation  steps  for  processing  the  data  generated  in 

step  N2.1  to  determine  the  model  parameter  vector  £  using  the  model 

reference  configuration  appear  here  as  steps  N2.2  through  N2,5# 

Step  N2.2  essentially  says  "try  the  system  inputs  u  on  the  model  with 

one  parameter  vector  p  and  generate  the  model  outputs  z  ."  Step  N2.3 

*~m 

then  says  "calculate  how  close  the  model  was  to  the  system  for  that 
£."  Steps  N2.4  and  K2.5  then  say  "using  our  knowledge  of  the  system 
and  our  experience  at  trying  different  values  of  £  and  getting  a 
larger  or  smaller  C  (p_),  we'll  decide  on  another  value  of  £  to  use 
and  try  again  until  we  can't  get  C  (£)  any  smaller."  Thus,  the  model 
reference  identification  technique  can  be  viewed  as  the  system  shown 
in  Figure  N2.2  in  which  the  inputs  are  u,  v,  w,  and  u  while  the 
outputs  are  sets  of  £'s  and  their  corresponding  C  (u,  £)'s. 


Model  Reference 
Identification 

e,  C    fi,       ■n'l 

V  u 

t>  O     ^U,     £/ 

v  ■  ■     * 

fc£ 

^o           * 

Figure  N2.2     MODEL 

REFERENCE  IDSNTIF! 

[CATION  SYSTEM 
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N2»3  FURTHER  COMPUTATIONAL,  CONSIDERATIONS 

Several  things  can  happen  during  the  model  reference  identifi- 
cation process  which  may  make  its  results  useless,  make  the  technique 
inapplicable  to  a  given  system,  or  cause  erroneous  conclusions  to  "be 
dravm  from  the  results.  In  the  first  phase,  certain  values  of  p_  in 
the  mathematical  model  may  result  in  unstable  solutions  and  thereby 
meaningless  or  infinite  values  of  both  z     and  C  (p).  The  values  and 
ranges  of  p_  must  be  specified  to  avoid  unstable  solutions  or  perhaps 
singular  solutions. 

Another  possibility  is  that  the  mathematical  model  structure 
could  be  erroneous  or  inadequate 8   In  that  case  the  model  reference 
technique  would  still  give  values  for  p_  and  C  (pj ,  but  the  minimum 
value  of  C  (p_)  might  be  very  large,  indicating  that  no  value  of  £ 
really  brought  the  model  close  to  the  system.  This  kind  of  behavior 
could  also  be  expected  when  the  input  noises  or  uncertainties  were 
very  large  in  comparison  to  the  system  variables.  In  the  case  of 
improper  structure,  the  mathematical  model  structural  changes  which 
resulted  in  lower  values  of  C  (p_)  for  a  given  input  should  probably  be 
retained  in  the  model.   It  could  be  expected  that  different  values  of 
the  optimum  £  would  result  from  these  changes, 

A  similar  situation  derives  from  a  possible  misunderstanding  of 
the  meaning  of  identification.  Parametric  identification  as  defined 
in  Chapter  Nl  does  not  imply  that  a  single  value  of  £  which  perfectly 
models  the  system  exists  or  is  desirable.  No  specification  was  made 
as  to  "how  close"  the  minimum  value  of  C  (p_)  had  to  be  to  zero  in 
order  to  call  the  system  "modeled."  In  general,  the  desired  closeness 
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of  modeling  depends  upon  the  purpose  for  which  the  model  is  to  be 
used  (A-13)«   Therefore,  if  a  given  system  results  in  a  large  number 
of  p_'s  which  minimize  C  (£),  the  statement  that  p_  is  "unidentifiable" 
because  a  single  value  cannot  be  found  to  model  the  system  is  erroneous. 
The  stated  criterion  vras  to  minimize  C  (p_)  and  any  £  which  does  so  is 
an  "identified"  value.  However,  suppose  that  for  a  given  system  and 
input  every  value  of  £  resulted  in  the  same  C  (p_) ,  then  by  the  para- 
metric identification  problem  definition  of  Figure  Nl.l,  £  would  be 
completely  identifiable  since  any  value  of  £  would  minimize  C  (pj. 
In  this  case  considerations  external  to  that  defined  problem  would 
enter  and  say  whether  or  not  the  system  was  adequately  "modeled"  by 
any  value  of  £.  Model  structure  or  input  function  changes  would 
probably  be  indicated  at  that  point, 

A  final  possibility  is  that  the  inputs  to  the  system  and  model 
might  be  of  such  type  that  variations  in  £  might  be  meaningless,  as  in 
the  previous  example.  To  further  illustrate  this  point,  consider  a 
noiseless  vehicle  initially  at  rest  and  with  all  inputs  set  at  zero. 
In  that  case,  all  outputs  would  be  zero  and  C  (0,  £)  would  be  a  constant 
C  for  all  £„  If  the  input  were  changed,  however,  the  values  of  C  (2) 
would  probably  change.  Thus,  the  object  of  modeling  is  to  find  a 
structure  and  set  of  parameters  £  which,  in  some  limited  sense,  result 
in  a  minimum  set  of  C  (u,  pj  which  are  valid  for  a  number  of  different 
inputs  u  and  produce  the  same  optimum  set  of  parameters  £, 
N2 , 4  COST  FUNCTION  PLOTTING 

The  model  reference  identification  technique  has  been  previously 
described  as  an  evaluation  of  C  (2)   over  a  limited  space  of  parameters 
£  in  such  a  way  that  a  specific  £  is  found  which  minimizes  C  (p_), 
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The  outputs  of  the  model  reference  system  in  Figure  N2.2  are  the 
spatial  values  of  p_  and  their  corresponding  cost  functions  C  (p_). 
If  the  optimum  value  of  p_  is  designated  p_*,  and  its  corresponding 
minimum  value  of  C  (p_*)  is  designated  C*  ;  then  for  a  scalar 
parameter  p  a  typical  cost  function  curve  might  be  as  shovm  in 
Figure  N2.3* 


If  a  predetermined  range  for  p  were  set  £p  <  p  <  p,],  and  then 
the  values  of  C  (p)  were  computed  at  increments  of  p  within  that 
range;  then  the  plotting  of  the  values  of  C  (p)  vs.  p  would  allow  the 
observer  to  minimize  C  (p)  simply  by  looking  at  the  plot*  The  actual 
minimization  is  in  that  case  performed  by  the  person  reading  the  plot 
and  not  by  a  decision  and  modification  roleg  such  as  a  gradient 
algorithm  (B-7). 

This  type  of  model  reference  identification  has  both  advantages 
and  disadvantages.  The  primary  advantage  of  the  plotting  technique 
is  that  it  provides  the  plot  reader  with  more  information  about  the 
parametric  behavior  of  the  system  than  just  the  values  p*  and  C*. 
By  observing  the  shape  and  magnitude  of  the  curve,  the  plot  reader 
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can  instantly  see  such  facets  as  multiple  minima,  absolute  and 
relative  minima,  sharpeness  or  well  defined  shape  of  the  minimum,  and 
the  overall  slope  and  value  of  the  cost  function  over  the  specified 
range  of  p.   In  effect,  the  plot  provides  not  only  identification 
but  also  identifiability  information  about  the  behavior  of  a  specific 
parameter. 

Another  advantage  to  the  technique  is  that  it  is  a  well  specified 
computation  problem.   This  means  that  it  does  not  require  any  exten- 
sive computation  in  the  decision  and  modification  algorithm,  since  the 
new  value  of  p  is  merely  the  old  one  plus  an  increment,, 

The  primary  disadvantage  of  this  form  of  plotting  technique  is 
that,  in  general,  a  larger  number  of  parameter  values  and  corresponding 
cost  function  values  must  be  computed  than  for  a  technique  using  a 
computed  decision  and  modification  routine.  This  becomes  very  signifi- 
cant when  the  amount  of  computation  involved  in  each  evaluation  of 
C  (p)  is  large.   For  the  case  in  which  p*  was  located  in  the  center 
of  the  range  £p  <  p  <  p,  ~\   and  in  which  the  increments  were  set  equal, 
then  the  curve  of  Figure  N2«3  would  require  about  twice  as  many  C  (p) 
calculations  as  for  a  gradient  algorithm  started  at  p  or  at  p,  . 

Another  disadvantage  of  this  technique  is  that  it  only  permits 

observation  of  the  behavior  of  one  parameter  at  a  time.  If  the 

general  case  of  the  vector  parameter  p_  were  to  be  analyzed  with  this 

technique,  there  would  be  n  plots  required  in  order  to  look  at  the 

selected  behavior  of  the  n  parameters.   However,  it  is  important  to 

note  here  that  the  p_*  formed  by  taking  the  individual  minimum  values 

of  each  of  these  curves  would  NOT  in  general  be  the  optimum  p_*  for 

the  system  when  all  of  the  parameters  were  varied  at  once.   In  order 
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for  this  to  be  true,  the  individual  parameter  must  be  shown  to  be 
"uncoupled"  in  the  system  equations  in  some  manner. 

In  the  case  of  ocean  vehicle  coefficients  and  parameters  which 
enter  as  products  of  states  in  a  linear  fashion,  it  is  expected  that 
theoretical  investigations  could  show  which  are  coupled  to  which. 
Certainly  one  would  not  expect  a  coefficient  such  as  X   to  be 
coupled  to  Y  ,  but  one  would  expect  X   to  be  coupled  to  X  •  Thus, 
in  some  cases  these  independent,  individual  plots  would  be  very  useful, 
but  in  other  cases  they  would  be  inapplicable,, 

V/ith  the  initial  study  of  an  ocean  vehicle's  coefficients  and 
parameters  in  mind,  an  overview  of  the  above  advantages  and  disadvan- 
tages leads  the  system  modeler  to  the  conclusion  that  the  knowledge 
of  identifiability  is  worth  its  coste  However,  it  is  more  efficient 
from  the  standpoint  of  the  human  visual  interpretation  process  and 
from  the  standpoint  of  practical  decoupling  of  ocean  vehicle  models 
to  look  at  the  behavior  of  two  parameters  at  once.  This  leads  to  cost 
function  contouring. 
N2.5  COST  FUNCTION  CONTOURING 

Suppose  there  are  two  parameters  p..  and  p?  in  p_  which  are  of 
specific  interest.  One  way  of  applying  the  previously  discussed  visual 
identification  procedure  is  to  attempt  to  make  a  three-dimensional 
plot  using  contours  of  the  cost  function  over  the  defined  space  of  p, 
and  p?  on  a  two-dimensional  plot.  Such  a  set  of  contours  would  appear 
as  Figure  N2.'!-  for  the  case  in  which  the  ranges  of  the  parameters  are 
Cp  1  Pi  <  Phl  and£p  <  Po  ^  PrJ'  The   curves  in  Figure  N2.4  represent 
lines  of  constant  values  of  C  (p-,  ,  p  )  with  the  minimum  values  being 
at  the  center  and  the  maximum  values  along  the  edges  of  the  plot, 
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pf      Pd 


Figure  N2.4  EXAMPLE  DUAL  PARAMETER  COST  FUNCTION  CONTOURS 


Visual  inspection  of  this  set  of  contours  shows  that  in  this  case 
C  (p, t   P?)  is  shaped  like  a  bowl  with  a  clearly  defined  minimum  at 

(px».p2*). 

In  some  cases  it  may  be  desirable  or  necessary  to  greatly 

accentuate  the  minimum  value  of  C*  in  Figure  N2.4,  This  can  be 

accomplished  by  contouring  the  natural  logarithm  log  C  (p)  vs.  p 

e    — 

or  by  using  some  other  form  of  weighting  curve  for  the  cost  function. 

All  of  the  considerations,  advantages,  and  disadvantages  which 
were  discussed  concerning  cost  function  plotting  in  Chapter  N2.4 
apply  also  to  cost  function  contouring.  The  big  advantage  of  contouring 
vs.  plotting  is  that  the  coupling  of  two  parameters  can  be  easily 
observed,  and  thus  coupling  ties  amoung  parameters  can  be  established 
in  pairs,  However,  even  with  the  pairs  and  their  associated  coupling, 
the  set  of  individual  optimal  pairs  may  not  be  the  totally  optimal  p_* 
because  there  may  be  higher  dimensional  coupling.  Another  significant 
consideration  is  that  whereas  the  cost  function  plotting  was  estimated 
to  require  about  twice  as  many  calculations  as  a  gradient  algorithm, 
the  cost  function  contouring  is  estimated  to  require  about  2*n.  times 
as  many  calculations  as  a  gradient  algorithm,  where  n.  is  the  number 
of  parameter  incremental  values.   However,  this  method  offers  great 
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promise  for  ocean  vehicle  coefficients  through  second-degree  and  is 
the  model  reference  technique  employed  in  this  thesis  for  studying 
coefficient  and  parameter  identifiability. 

This  chapter  has  presented  an  overview  of  model  reference  identif- 
ication and  the  specific  techniques  of  cost  function  plotting  and  cost 
function  contouring*  The  techniques  of  this  chapter  are  applied  to 
simple  ocean  vehicle  models  in  Section  4  (P)  and  to  the  complete 
DSRV  dynamic  model  in  Section  6  (C).   The  primary  benefit  deriving 
from  the  application  of  this  method  is  a  knowledge  of  the  identifi- 
ability characteristics  of  the  parameters,  especially  in  the  presence 
of  noise.   The  next  chapter  presents  the  equations  and  a  discussion 
for  the  method  of  extended  Kalman  filtering.  This  method,  unlike 
model  reference,  takes  into  account  the  characteristics  of  the  system 
noises  v  and  w  and  uses  a  decision  and  modification  algorithm  to 
calculate  the  successive  values  of  p_  to  minimize  C  (pj. 
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CHAPTER  N3 

EXTENDED  KALMAN  FILTERING 

Another  method  which  can  be  applied  to  the  parametric  identifi- 
cation problems  of  Chapter  Nl  is  that  of  extended  Kalman  filtering, 
Kalman  filtering  is  essentially  a  linear  technique  with  a  firm  theo- 
retical foundation  which,  when  extended  to  specific  nonlinear  systems, 
loses  its  theoretical  foundation  but  sometimes  viorks  extremely  well. 
This  chapter  presents  the  linear  Kalman  filter  equations  from  the 
literature  and  then  presents  the  extended  equations  for  nonlinear 
systems.  These  equations  will  be  used  in  the  DSRV  example  coeffi- 
cient studies  of  later  sections  of  this  thesis,  Kalman  filtering  is 
a  technique  for  estimating  the  state  of  a  linear  dynamic  system. 
Therefore,  the  first  step  in  applying  such  a  technique  to  parametric 
identification  problems  is  to  convert  them  to  state  estimation 
problems, 
N3.1  CONVERTING  PARAMETRIC  IDENTIFICATION  TO  STATE  ESTIMATION 

Identifying  parameters  can  be  made  equivalent  to  estimating 
states  simply  by  treating  the  parameters  as  states  in  the  dynamic 
system.  In  effect  this  is  merely  a  redefinition  of  the  state  vector 
x  in  equations  Nl.l  and  N1.2  to  include  the  parameter  p_  as  in 
equations  N3«1|  N3c2,  and  N3«3»   The  structure  vectors  f  and  h  are 


x  ■ 


From  equations  Nl.l  and  N1.2     N3.1 


rp 

k  =  1   (*»  HL»  w»  t)  5  £  -  [£•  g]   E<1«  N1*1       N3.2 


z  -  h  (x,  u,  v,  t)  j  h  ■  h   Eq.  N1.2  N3.3 


-105- 


similarly  augmented  with  the  structure  relationships  for  the  param- 
eters (i,e.  £  =  g).   With  this  definition  the  parametric  identifica- 
tion problem  of  Figure  Nlel  becomes  the  state  estimation  problem 
of  Figure  N3.1. 


Given? 

State  Equation 

x  =  f  (x,  u,  w,  t)  N3.2 

Measurement  Equation 

z  «■  h  (x,  u,  v,  t)  N3.3 

Cost  Functional 

C  *  C  (z,  z   )   ;  C  >  0  N3.^ 

—   """la         — 

Using; 

u  (t),  z  (t),  f,  g,  h,  x  (tQ),  tQ,  C 
Find; 

x  (t)  to  minimize  C  (or  to  maximize  -C) 

Figure  N3.1  A  GENERAL  STATE  ESTIMATION  PROBLEM 


The  ocean  vehicle  parametric  identification  problem  is  converted 
to  an  ocean  vehicle  state  estimation  problem  in  exactly  the  same 
manner „  If,  in  addition,  it  is  recognized  that  the  input  functions 
u  (t)  are  known  vehicle  maneuvers  (functions  of  time)  and  are  not 
optimal  control  inputs  which  might  depend  upon  the  state,  then  the 
effect  of  u  (t)  is  simply  to  make  f  behave  as  a  time-varying  system. 
With  these  considerations,  the  ocean  vehicle  parametric  identifica- 
tion problem  of  Figure  N1.3  becomes  the  corresponding  state  estimation 

problem  of  Figure  N3»2,  As  mentioned  in  previous  chapters,  the  model 
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equations  for  calculating  z  are  the  state  and  measurement  equations 
with  the  noises  v  and  w  set  to  zero. 


Given: 

State  Equation 

x  -  f  (x,  t)  +  w 

N3.5 

Measurement  Equation 

<l_  «  x  +  v   ;   x  =  primary  states  only 

N3.6 

Cost  Functional 

c  =  ltf  (z  -  z  )T  R"1  (z  -  z  )  dt 
o 

N3.7 

Using: 

z  (t),  f,  x  (to),  tQ,  C,  £  =  0 

Find: 

x  (t)  to  minimize  C  (or  to  maximize  -C) 

Figure  N3.2  THE  OCEAN  VEHICLE  STATE  ESTIMATION 

PROBLEM 

Neither  of  the  state  estimation  problems  in  Figures  N3.1  and 
N3.2  has  a  general  solution  or  a  directly  applicable  general  solution 
technique.  The  complexity  of  these  very  general  problems  must  be 
significantly  reduced  before  any  general  techniques  are  applicable. 
The  next  steps  in  the  equation  developments  of  this  chapter  are, 
therefore,  to  present  a  general  problem  vrhich  is  solvable,  namely 
the  linear  problem,  and  then  to  extend  it  to  a  reduced  version  of  the 
ocean  vehicle  state  estimation  problem  and  present  the  corresponding 
equations. 
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N3.2.  KALMAN  FILTERING  FOR  LINEAR  SYSTEMS 

The  Kalrnan  Filter  equations,  their  derivatives,  their  applications, 
and  their  theoretical  foundations  are  presented  in  many  different 
forms  throughout  the  literature.  The  basic  form  to  be  used  in  this 
thesis  is  given  by  Brock  (B-8) ,  and  similar  forms  appear  in  Bryson  and 
Ho  (B-7),  Ho  and  Lee  (H-3)  and  Sage  (S-3).  Brock's  development  and 
explanation  of  these  filtering  equations  and  of  the  overall  filtering 
process  is  somewhat  unusual  in  that  both  continuous  and  discrete 
equation  forms  are  used.  However,  this  seems  to  allow  simpler 
notation  and  more  straight fore ward  computational  implementation 
than  either  completely  continuous  or  completely  discrete  forms. 

In  the  general  parametric  identification  problems  of  Chapter  Nl 
and  in  the  model  reference  identification  technique  of  Chapter  N2 
no  assumptions  were  made  concerning  the  characteristics  of  the 
stochastic  processes  (or  noises)  v  and  w.  The  basic  Kalrnan  filter- 
ing technique  for  linear  systems  requires  rigid  assumptions  of  the 
form  of  v  and  w  and  known  numerical  characteristics  of  these  two 
noises.  Specifically,  yand  w_nare  assumed  to  be  zero  mean,  uncor- 
rected, gaussian  white  noise  processes  described  in  equations  M^.7 
through  M^-,10  with  assumed  or  known  process  noise  covariance  Q  and 
measurement  noise  covariance  R,  The  Kalrnan  filter  can  then  be  shown 
(B-8)  (H-3)  to  be  the  optimum  estimator  for  the  state  of  the  given 
linear  system.  Discrete  noises  wn,  v  are  used  in  simulations  (Chap.  T2). 

Developments  in  the  literature  also  permit  the  application  of 
the  linear  Kalrnan  filtering  technique  to  systems  with  relaxed 
constraints  on  the  noise  characteristics.  A  large  number  of  these 
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extensions  with  regard  to  the  characteristics  of  v  and  w  such  as 
non-zero  mean,  correlated,  tiine  structured,  and  non-gaussian  v  and 
w  are  discussed  by  Schweppe  (S-6).   The  system  in  which  the  matrices 
Q  and  R  are  unknown  and  must  be  determined  is  discussed  by  Abramson 
(A-2). 

The  Kalman  filtering  technique  is  presented  here  by  describing 
its  computational  steps,  as  was  done  with  the  model  reference 
technique  in  Chapter  N2,   These  steps  and  their  corresponding 
equations  are  presented  as  steps  N3»l  through  N3«8,   In  both  the 
model  reference  and  the  Kalman  filtering  techniques  the  first  step 
is  to  collect  or  generate  the  noisy  data  z_  and  inputs  u.  For  the 
purposes  of  this  thesis  those  values  will  be  discrete  time  values 
of  the  system  inputs  and  outputs,  although  the  procedure  is  somewhat 
the  same  for  continuous-time  system  data,  (B-7)e  The  Kalman  filtering 
technique  implicitly  assumes  that  the  data  is  produced  by  a  linear 
system,  and  so  in  the  case  of  simulated  data,  a  linear  system  would 
be  used. 

Steps  N3.2  through  N3.8  provide  an  iterative  procedure  for 
processing  the  noisy  data  generated  in  Step  N3.1  in  such  a  way  as  to 
get  optimal  estimates  of  the  system  states  at  each  time  step  t  „ 
The  continuous  differential  equations  in  N3.1f  N3.2,  and  K3»3  are 
solved  in  this  thesis  by  a  digital  computer  using  an  Euler  integrator 
as  given  by  Equation  N3»8.  However,  more  sophisticated  integration 

%+i  ■  *i +  MVi  -  V  N3-8 

techniques,  both  implicit  and  explicit,  such  as  Runge-Kutta  or 

Adams-Moulton,  could  be  employed  here  (H-5). 
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Kalman  Filtering  Computation  Steps 

Step  N3«l   Collect  or  generate  noisy  data  z_  and  inputs  u 


x  -  F(t)  x  +  w 

z  »  H  x  +  v 

E  ■  E  C  ii]  "  P.  *  1  a   E  C  xl 

Q  =  E  T  w  v/1"]  ;  R  =  E  [  v  vT1 


TL-TL- 


x(t  )  -  X 
—  o 


~o 


(solved  discretely  by 

computer  for  %     at 

time  t  ) 
ny 

>  N3.1 

(uncorrelated  w^  and  v  ) 


i-E>-Step  N3.2   Propagate  the  estimated  state  x  one  time  increment  t. 


Step  N3.^- 


Step  N3c5 


Step  N3.7 


1 — Step  N3.8 


x  =  F(t)  x 


*(t0) 


£,  -  x 

-O    — o 


z 

—m 


A 

H  x 


N3.2 


Step  N3c3   Propagate  the  error  covariance  matrix  E 


E 


FE  +  EPT+  Q       ;        E(t  )  »  E[xq_x0T] 


N3e3 


r    T~i      T  A 

E  «  E[_  e  e  J  =  e  e   ;   £  -  2£  ~  * 

e  m   state  estimate  error;  carat  denotes  estimate 

Calculate  the  Kalman  filter  gain  matrix  K  at  t 

K  «  EHT  (HEHT  +  R)"1 


A      A 

Update  the  estimated  state  x  to  x'  at  t 
x>  x  +  K  (z  -  zj  ;  zn  -  z(tn) 


N3.^ 


N3.5 


Step  N3.6   Update  the  error  covariance  matrix  E  to  E'  at  t, 


E*  =  E  -  KHE 

A 

Set  x*  and  E'  as  initial  conditions  for 
Step's  M3.2  and  N3.3at  tn 


N3.6 


X  (t  )  =  x«  (t  ) 

—   n'   —  x  n' 

E  (O  -  &    (tn) 


N3.7 


Branch  to  Step  N3.2  and  continue  until  the  end 
of  the  process. 
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Many  of  the  problems  encountered  in  the  model  reference  tech- 
nique may  also  be  encountered  with  Kalman  filtering,  both  system 
problems  and  computation  problems.   Most  of  these  are  treated  in  the 
same  manner  for  Kalman  filtering  as  they  were  for  model  reference 
in  Chapter  N2.   One  computation  problem  which  may  be  encountered  is 
that  of  the  error  covariance  matrix  E  going  negative  at  some  point 
in  the  process.   This  may  result  in  the  process  becoming  completely 
unstable  at  that  point  because  of  the  nature  of  equation  N3.6.   The 
causes  for  negative  E  may  lie  in  the  violation  of  some  of  the  basic 
theoretical  rules  for  Kalman  filtering,  or  the  causes  may  be  that 
the  computer  has  insufficient  accuracy  or  that  the  time  steps  were 
chosen  too  large. 
N3*3  KALMAN  FILTERING  EXTENDED  TO  NONLINEAR  SYSTEMS 

The  linear  Kalman  filter  is  also  valid  for  nonlinear  systems  as 

long  as  it  can  be  shown  that  the  errors  in  the  estimate  of  the  state 

can  be  approximated  by  a  linear  system.   The  detailed  steps  and 

theoretical  considerations  for  this  extension  are  presented  by  Brock 

(B-8)  for  the  nonlinear  system  in  equations  N3.9  (slightly  different 

notation). 

x  =»  f  (x,  w,  t) 

N3.9 
z   «  h  (x,  v,  t) 

The  equations  N3-9  are  inserted  into  Step  N3.1  in  order  to 
generate  the  data  using  a  general  nonlinear  stochastic  system.   The 
equations  N3.2  in  Step  N3.2  are  replaced  by  equations  N3.10  which 
have  the  same  structure  as  equations  N3*9  with  w  and  v  set  to  zero. 
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x  -  f  (%   t) 

N3.10 
z  »  h  (-X-,  t) 

The  error  covariance  matrix  equation  in  Step  N3»3  is  replaced  by 
equations  N3*ll»  and  the  Kalman  filter  gain  equation  in  Step  W)tk 

E  =»  FE  4-  EF  +  Q_ 


N3.ll 


dl(% 

t) 

if   — 

^ 

dL  $ 

.a*T 

% 

"  <)" 

^w 

is  replaced  by  equations  N3.12.  With  these  substitutions  the 

K  *  EHT  (HEHT  +  R  ) 
n' 

<)h  (ft,  t) 
H  -  ~^  N3.12 

^R  ^.T 
Rn  =  }v   «)v 

computation  steps  N3«l  through  N3«8  become  those  of  the  general 
technique  of  extended  Kalman  filtering, 
N3 .  ^  EXTENDED  KALMAN  FILTERING  FORJ)CEAN  VEHICLES 

The  extended  Kalman  filtering  stops  for  the  ocean  vehicle  state 
estimation  problem  can  now  be  derived  and  presented  as  Steps  N3.9 
through  K3.16  and  as  equations  N3.13  through  N3.19r  There  are  several 
very  significant  simplifications  which  result  from  the  symmetry  of 
the  E  matrix  and  from  the  fact  that  the  parameters  £  in  equation  N3«l 
are  assumed  to  be  constants  (i.e.  g_  =  0). 
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Extended  Kalman  Filtering  Steps  for  Ocean  Vehicles 

Step  N3.9 

Collect  or  generate  noisy  data  z_  and  inputs  u 

X  m   f  (x,  t)  +  w  ;  f  from  equation  N1.4 

N3.13 

a  =  Hx  +  v      (solved  discretely  for  zj) 

— e»Step  N3.10 

Propagate  the  estimated  state  x  to  t 

n 

x  =  f  (x,  t)   ;  f  from  equation  Nl.Jf 

N3.14 

z  «  Hx* 
-m    — 

Step  N3.ll 

Propagate  the  error  covariance  matrix  E  to  t 

•         t 

E  *  FE  +  EF  +  Q 

„  it  (x,  t)                    N3.15 

F  =    A 
<)x 

Step  N3.12 

Calculate  the  Kalman  filter  gain  matrix  K  at  t 

n 

K  -  EHT  (HEHT  +  R)                      N3.16 

Step  K3.13 

Update  x  to  x*  at  t 

i'   -   £  +  K  (z -  z  )   ;  zn  -  z(t  )        N3.17 

—    —       n  — m      — n   — *  n 

Step  N3.1** 

Update  E  to  E'  at  t 

E»  =  E  -  KHE         "                  N3.18 

Step  N3.15 

Set  x*  and  E'  as  initial  conditions  fcr 
propagation  equations  at  t 

x  (t.)  -  x«  (t  ) 

n                           N3.19 

' — Step  N3.16 

Branch  to  Step  N3«10  and  continue  until  the 

end  of  the  process 

— — 

Suppose  that  these  are  n  states  and  n  parameters  in  the  ocean 

vehicle  model.  This  means  that  the  state  estimation  problem  has 

n  =  n  +  n  states  and  that  equations  M3.14  are  actually  structured 
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as  in  equations  N3.20  and  N3.21.  Therefore,  instead  of  integrating  n 


E 


f  (x,  £,  t) 


£m 


'n*n 


0 


n*np 


where 

f 

is 

ng*l 

0 

is 

n  *1 

P 

^Hx* 

N3.20 


N3.21 


differential  equations  in  equation  N3.20,  only  n  equations  need  to 

s 

he  propagated.  In  addition,  the  H  matrix  which  has  dimension  n*n 

actually  has  only  n  nonzero  elements  which  are  the  H  ,  «  1  identity 

s  11 

matrix  diagonal  elements. 

Further  reductions  occur  in  Step  N3»H  because  of  the  symmetry 
of  E  (E  =  S  )  and  the  form  of  equation  N3.20  applied  to  equations  N3d5» 
Normally  the  E  matrix  is  n*n,  but  the  fact  that  it  is  symmetric  means 
that  there  are  n  (n  +  l)/2  unique  elements.  The  gradient  matrix  F 
is  also  of  a  special  form  described  by  equation  N3.22;  and  when 
included  in  the  error  covariance  matrix  propagation  equation,  the 


F  - 


'it  (£.  £.  t) 

di 

df  (£.  £.  t)" 
it 

0 

0 

of  dimensions 


n  *n 
s  s 


n  *n 

P  i 


s  p 


n  *n 

P  Pj 


N3.22 

form  of  equation  N3»23  results.  The  fact  that  there  are  significant 

numbers  of  zeroes  in  F  reduces  the  number  of  nonzero  elements  in  the 

E  equation  N3.23  to  a  total  of  n  (n  +  2n  ).   The  symmetry  of  E  and 

s   s     p 

of  Q  further  reduces  the  total  number  of  propagation  equations  to  the 
n  values  of  equation  N3.24. 
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E 


ns*ns 

n  *n 
P     s 

n  *n 

s     p 

n  *n 
P     P 

=: 

n  *n 
s     s 

0 

n  *n 

S       p 

0 

p 

\  sym. 


-I-  E 


^sym. 


n  *n  :   0 
s  s 


nP*ns  i   ° 


+  Q 


n  *n 
s  s 


N3.23 


n  ■  n  C(n«  +  l)/2  +  n 
e    s  u   s     ''      r>J 


N3.24 


These  reductions  are  highly  significant  from  a  computational 

standpoint  and  lead  to  the  possibility  of  solving  equations  with 

large  numbers  of  ocean  vehicle  parameters.  The  total  number  of 

differential  equations  which  must  be  propagated  in  Steps  N3.10  and 

N3.ll  is  n  +  n  .  Similar  considerations  to  the  above  lead  to 
s    e 

simplifications  in  the  Kalman  filter  gain  matrix  calculation  and 

in  the  updating  equations.   The  K  matrix  is  of  dimension  n*n  but 

s 

T 
only  requires  the  inversion  of  an  n  *n  matrix  because  of  the  HEK 

s  s 

structure  and  the  fact  that  the  matrix  R  is  of  dimension  n  *n  • 

s  s 
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The  form  of  H  in  equation  N3.21  greatly  simplifies  the  computation 
of  the  K  matrix.  The  updating  equations  require  n  updates  for  the 
states  and  n-(n  +  l)/2  updates  for  the  error  covariance  matrix. 

Consider  an  example  case  in  which  the  number  of  primary  states 
is  6  and  the  number  of  parameters  is  19^-  for  a  total  of  200  states 
in  the  estimation  problem.   In  this  case  n  -  6  and  n  =  1185  for  a 
total  of  1191  differential  equations  which  must  be  propagated,,  The 
K  matrix  calculation  requires  the  inversion  of  a  6*6  matrix  and  is 
of  dimension  200  *  6.  There  are  200  updates  for  the  states  and  20100 
updates  for  the  error  covariance  matrix  for  a  total  of  20300  updates. 
These  exa.rn.ple  numbers  are  really  not  intended  to  present  an  accurate 
measure  of  the  computation  effort  involved,  since  this  primarily 
depends  upon  the  complexity  of  the  basic  system  structure  f. 

This  chapter  has  presented  the,  extended  Kalman  filter  equations 
for  application  to  ocean  vehicle  parametric  identification.   The 
parametric  identification  problem  was  first  converted  to  a  nonlinear 
state  estimation  problem,  and  then  the  linear  Kalman  filter  equations 
were  extended  to  apply  to  that  nonlinear  problem.  The  detailed 
computational  steps  were  listed  for  the  linear,  nonlinear,  and  ocean 
vehicle  state  estimation  problems.  In  addition,  several  computa- 
tional simplifications  were  derived  for  the  ocean  vehicle  problem. 
An  overall  system  view  of  extended  Kalman  filtering  is  presented  in 
Figure  N3»3»  where  the  x  (t)  contains  the  parameters  £  (t)  in 
Figure  N2.2,  and  the  error  covariance  matrix  E  (t)  is  a  measure  of 
confidence  in  the  values  of  x. 
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Figure  N3.3  EXTENDED  KALMAN  FILTERING  SYSTEM 


The  next  chapter  presents  the  basic  equations  and  considerations 
for  studying  the  identifiahility  of  specific  parameters  in  nonlinear 
dynamic  system  mathematical  modelsc  Both  model  reference  and  extended 
Kalman  filtering  ca.n  be  used  to  study  identifiahility,  and  the  next 
chapter  describes  in  detail  how  each  technique  can  be  used  for  this 
purpose. 
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CHAPTER  114- 

STUDYING  IDENTIFIABILITY  OF  PARAMETERS 

One  primary  reason  for  using  identification  techniques  on  ocean 
vehicles  is  to  determine  their  mathematical  models  for  the  purpose 
of  simulating  the  motion  of  the  vehicle.   Identifiability  must  there- 
fore be  viewed  from  the  standpoint  of  the  overall  mathematical 
modeling  objective  or  system  modelability  rather  than  from  the 
standpoint  of  solving  a  specific  parametric  identification  problem. 
This  represents  a  somewhat  more  general  view  of  identifiability  than 
the  view  presented  in  the  discussions  of  Chapter  N2.3  in  that  not 
only  must  p_*  minimize  C  (p) ,  but  C  (p_*)  must  also  satisfy  the  system 
modeler's  criteria  for  a  good  mathematical  model.   If  the  cost 
function  C(p_)  is  truely  designed  to  represent  the  closeness  between 
the  model  and  the  system,  then  one'  of  the  modelability  or  system 
modeler's  criteria  might  be  interpreted  as  minimum  C  (£*)• 

In  this  thesis  the  parameters  for  the  mathematical  model  of  the 
DSRV  are  studied  for  their  identifiability  characteristics  by  using 
a  known  set  of  parameters  and  a  computer  simulation  with  added  noises 
to  generate  the  data  for  use  in  the  model  reference  and  Kalman 
filtering  techniques.   If  these  identification  techniques  result 
in  the  true  or  known  set  of  parameters,  then  the  system  modeler's 
confidence  in  the  identifiability  of  those  same  parameters  vihen  found 
from  real  vehicle  data  is  greatly  increased.   However,  if  the  true 
or  known  set  of  parameters  are  .not  found,  then  the  system  modeler 
must  question  many  of  the  original  steps  used  in  the  modeling  and 
identification  processes.   In  this  case  the  conclusion  might  be 

reached  by  the  system  modeler  that  the  original  uararneters  are 
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unidentifiable  either  with  or  without  noise.   This  conclusion,  if 
well  founded,  would  he  valuable  information  from  the  standpoint  of 
the  time  saved  trying  to  find  unidentifiable  parameters  from  the  real 
vehicle  data.  If  the  true  or  known  set  of  parameters  are  shown  to 
be  identifiable  with  multiple  values  which  minimize  C  (p_) ,  then  the 
system  modeler  can  use  this  information  in  interpreting  the  param- 
eters found  from  identification  passes  on  real  vehicle  data.   In 
summary,  identifiability  studies  provide  the  system  modeler  with  a 
"bridge"  between  the  mathematical  model  parameters  found  from  simu- 
lated data  and  those  found  from  real,  vehicle  data.  In  this  thesis 
identifiability  studies  will  be  concerned  with  finding  the  original 
set  of  parameters  used  in  the  vehicle  simulation  rather  than  with  the 
single  problem  of  minimizing  C  (p_). 

There  is  at  present  no  absolute  or  universally  accepted  definition 
of  identifiability  for  parameters  in  mathematical  models  (S-6, 
Chap.  18),  First  of  all,  there  is  no  guarantee  that  the  general 
parametric  identification  problem  is  solvabJ.e  or  that  there  exists 
a  p_*  which  will  minimize  a  general  nonlinear  cost  function  C  (p_). 
Then  if  C  (p_)  can  be  shown  to  have  a  minimum  value,  there  is  no 
guarantee  that  such  a  minimum  is  unique  or  that  the  actual  minimising 
value(s)  of  p_*  could  ever  be  found,   Identifiability,  therefore, 
might  refer  to  the  capability  or  theoretical  possibility  of  finding 
a  p_*  to  minimize  C  (p_),  or  identifiability  could  be  some  measure  of 
the  computational  difficulty  involved  in  finding  one  or  more  values 
of  p_*  accurately  for  a  given  form  of  C  (p_). 

This  chapter  presents  a  general  view  of  the  concepts  of  model- 
ability  and  identifiability.  For  use  in  this  thesis  a  general 
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definition  of  modelability  is  given,  and  then  identif lability  is 

defined  and  shown  to  be  one  of  the  factors  affecting  modelability. 

These  definitions  are  then  interpreted  in  terms  of  both  quantitative 

and  qualitative  measures,  and  the  direct  applicability  of  these 

measures  to  the  identification  studies  of  the  DSRV  and  of  other 

vehicles  is  discussed, 

N4 . 1  THE  CONCEPTS  AND  DETERMINING  FACTORS  OF  MODELABILITY  AND 
IDENTM  ABILITY 

In  Chapter  Ml el  the  concept  of  understanding  the  behavior  of  a 
physical  system,  namely  an  ocean  vehicle,  was  discussed.   There  are 
two  approaches  which  can  be  taken  with  regard  to  gaining  such  an 
understanding:  microscopic  (theoretical)  and  macroscopic  (pragmatic). 
In  the  microscopic  approach,  one  begins  with  the  known  basic  physical 
laws  of  matter  and  the  axioms  of  mathematics  and  develops  a  mathemat- 
ical model  for  the  behavior  of  the  system  with  a  rationally  understood 
and  connected  set  of  steps.   In  the  macroscopic  approach,  one  begins 
with  the  characteristics  of  the  input-output  behavior  of  the  system 
and  attempts  to  deduce  the  mathematical  model  for  such  behavior. 
Both  of  these  approaches  contribute  to  the  total  understanding  of 
the  system,  but  any  true  or  complete  understanding  of  the  physical 
system  must  include  the  microscopic  approach.   However,  system 
modelability  might  apply  to  the  microscopic  or  macroscopic  approaches. 

Modelability  is  the  capability  of  mathematically  modeling  or 
simulating  a  physical  system.   In  this  thesis  the  physical  systems  to 
be  modeled  are  ocean  vehicles  or  physical  models  of  ocean  vehicles, 
but  the  concept  can  be  applied  to  any  physically  existing  dynamic 
system.  Note,  however,  that  modelability  does  not  imply  or  require 
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a  complete  understanding  of  the  system,  but  that  such  an  understand- 
ing would  imply  model ability.  This  thesis  is  concerned  with  model- 
ability  as  applied  to  the  macroscopic  approach  for  modeling  physical 
systems  as  state  determined  dynamic  systems  (Section  M). 

Let  the  modelability  of  a  physical  system  be  designated  by  the 
scalar  functional  M  and  the  identifiability  of  a  set  of  parameters 
in  a  general  parameter  vector  £  by  the  scalar  functional  I,  The 
modelability  and  identifiability  functionals  can  then  be  described  in 
terms  of  the  factors  in  the  modeling  process  upon  which  they  are 
dependent  as  in  equations  N'+.l  and  N^.2.   The  dividing  line  between 

M  -  M  (f ,  g,,  h,  C,  Id,  Int,  v,  w,  I,  •••)        N4.1 

I  =  I  (u,  Xq.  Pq.  &t,  Q,  R,  *••)  Nif.2 

Where:  f  »  system  structure  vector 

g_  =  parameter  structure  vector 

h  -  measurement  structure  vector 

C  «*  cost  functional  structure 

Id  =  identification  method 

Int  a  integration  method  or  solution  technique 

v  =>  measurement  noise  structure 

w  =  process  noise  structure 

u  =»  vector  of  vehicle  inputs 

x  =  starting  state  vector 

p  =»  starting  parameter  vector 

6t  =  time  increment  in  discrete  process 

Q  «  process  noise  parameters 

R  =  measurement  noise  parameters 
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M  ■  mathematical  modelability  measure 

I  =  parametric  identifiability  measure 

D  =  dependent  variaW.es  of  I  (d) 

S  =»  dependent  structure  of  M  (S,  C,  l) ; 

S  -   all  except  C  and  I 

M  and  I  need  not  be  as  specific  as  in  equations  H^.l  and  lUj-,2,  and 

in  fact  many  of  the  dependents  in  these  two  equations  could  apply  to 

both  functionals.  The  modelability  definition  used  here  has  M 

primarily  dependent  upon  the  structure  of  the  system  and  of  the 

modeling  process,  and  the  identifiability  definition  is  set  up  to  have 

I  be  dependent  upon  the  numerical  values  in  the  parametric  idcntifi- 

< 

cation  process  for  a  fixed  structure  and  modeling  procedure.  There 
are  many  other  factors  which  might  be  included  as  dependent  func- 
tionals in  M  and  I  such  as  the  size  and  speed  of  the  computational 
facility  to  be  used  in  the  modeling  and  identification  processes, 
the  available  manpower  to  formulate  the  problems,  the  available 
Computation  time,  desired  model  accuracy,  etc. 

The  system  modeler  begins  by  specifying  the  structures  of  the 
dependent  functionals  in  14,  and  then  proceeds  to  specify  the  depen- 
dent variables  in  I,  Then  the  parametric  identification  problem  is 
investigated  to  determine  its  parametric  identifiability;  and  if  the 
parameters  are  identifiable,  then  one  or  more  values  of  p_*  which 
minimize  C  (p_)  are  determined.   If  the  parameters  in  the  parametric 
identification  problem  are  not  identifiable  or  if  the  value  of  C  (p_*) 
is  too  large  to  allow  the  system  to  be  called  "modeled,"  then  the 
structure  of  the  functional  dependents  in  M  is  varied  and  the  entire 

process  repeated  iteratively  until  satisfactory  modeling  is  achieved, 
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A  similar  iteration  process  can  be  described  for  the  solution  to 
the  general  parametric  identification  problem.  The  dependent  variables 
in  I  are  specified  and  attempts  are  made  to  find  p_*  to  minimize 
C  (p_*).  If  this  is  impossible  or  too  difficult,  then  the  dependent 
variables  are  changed  in  some  manner;  and  the  identification  process 
is  repeated  iteratively  until  satisfactory  identification  is  achieved 
or  until  the  parameters  are  shown  to  be  unidentifiable,   A  flowchart 
for  the  modeling  and  identification  ideas  discussed  above  is  presented 
in  Figure  N*4-.l.  The  overall  goal  of  the  system  modeler  in  Figure  N4.1 
might  be  to  find  the  S*  which  would  minimize  C  (p_--t  S) , 

The  studies  in  this  thesis  are  especially  relevant  to  the  identi- 

* 

fying  process  and  specif ically  to  blocks  k   through  9  in  Figure  N^.l. 
In  Sections  2  (M)  and  3  00,  and  5  (D)  the  structure  of  the  modeling 
process  is  specified  as  to  the  structure  of  the  equation  and  the 
identification  procedures  to  be  used.  Sections  k   (P)  and  6  (C) 
represent  the  theoretical  and  DSRV  example  steps  to  be  followed  in 
blocks  5  and  6  of  Figure  N4.1.  Another  system  modeler  would  have  to 
tailor  the  blocks  in  Figure  N^.l  to  his  specific  dynamic  system  and 
his  facilities  for  studying  it.   Several  explicit  quantitative  and 
qualitative  methods  for  studying  identifiability  for  a  specific  ocean 
vehicle's  parameters  can  now  be  developed.   These  identifiability 
measures  ere   discussed  in  the  remainder  of  this  chapter  and  applied 
to  the  DSRV  mathematical  model  in  Sections  H-   (P)  and  6  (C), 
N4.2  IDENTIFIABILITY  FOR  OCEAN  VEHICLE  PARAMETERS 

It  is  now  desirable  to  specialize  the  general  procedure  of 
Figure  N^-.l  to  the  models  of  Section  M  and  the  identification  tech- 
niques of  this  section.  This  means  that  the  forms  of  S  and  C  in 
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Figure  N^.l  FLOWCHART  FOR  MODELING  AND  IDENTIFICATION 
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equation  N'l.l  are  fixed  to  those  equations  and  identification  tech- 
niques previously  presented  and  are  summarized  in  equations  N4.3  and 
UkA,      With  these  structural  functions  now  fixed,  the  identif lability 


M  - 

fixed 

S  and  C;  assumed  modelable            N4.3 

I  - 

I 

(«. 

Po,  q.  r)                                             n^ 

Where : 

S 

83  h   £»  h.*   c»  Id»  Int»  X»  SL 

f. 

£,  h,  C  given  in  Figure  N1.3.  ocean  vehicle 
structure 

Id 

.  given  by  equations  N3.13  through  N3»19  for 
Kalman  filtering  and  by  steps  N2,l  through 
N2.5  for  model  reference  contouring 

Int  given  "by  equation  N3.8;  Euler 

Vt 

w  given  by  equations  Vik.7   through  M4.10, 
gaussian  v/hite  noises 

of  the  specific  parameters  of  an  ocean  vehicle  can  now  be  defined, 
discussed,  and  measured. 

A  parameter  p.  belonging  to  the  vector  p_  will  be  termed  identifi- 
able if  one  or  more  values  of  p *  may  be  found  from  simulated  vehicle 
data  by  model  reference  contouring  or  by  extended  Kalman  filtering. 
The  identif lability  of  p.  will  then  refer  to  the  ease  with  which 
one  or  more  values  of  p.*  may  be  found  or  "seen"  in  the  model  reference 
contours  and  to  the  accuracy  with  which  it  may  be  determined  by 
extended  Kalman  filtering. 

It  is  important  at  this  point  to  ensure  that  this  definition 
be  interpreted  properly,  and  not  be  placed  at  odds  with  the  discussion 
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in  the  introduction  to  this  chapter  or  in  Chapter  N2.3.   Equation 
N^.3  assumes  modelability  or  that  C  (p-)  will  be  small  enough  that  the 
vehicle  will  be  adequately  modeled  by  the  structure  and  value  of  p_*. 
This  also  implies  that  C  (p_)  has  some  structure  to  it  which  will 
preclude  the  possibility  of  all  values  of  p_  minimizing  C  (p_) .   There- 
fore, somewhere  within  the  space  of  all  possible  values  of  p_ 
[i.e.  (~  oo  <  p_  <  +  co)[]  there  must  be  a  subspace  of  values  which  will 
minimize  C  (p_).   It  is  therefore  possible  to  talk  about  the  diffi- 
culties involved  in  finding  that  subspace* 

In  the  identification  studies  of  this  thesis  an  ocean  vehicle 
(DSRV)  is  simulated  using  the  model  structure,  gaussian  white  noise 
processes,  and  a  fixed  set  of  parameters  p_*.  Noisy  input-output  data 
is  collected  from  this  simulation  and  processed  using  the  identifica- 
tion techniques  to  determine  p_*  once  again.  The  closeness  with  which 
these  procedures  give  the  true  value  of  p_*  then  determines  how  well 
the  identification  procedure  works,  how  easily  and  accurately  the 
parameter  is  identified,  and  to  some  extent  whether,  if  the  parameter 
p_*  were  unknown  for  a  real  vehicle,  the  identified  value  would 
adequately  model  the  real  vehicle.   It  is  for  these  considerations  in 
this  thesis,  that  identif lability  is  concerned  with  the  difficulties 
involved  in  finding  a  specific  and  unique  minimizing  value  of  p_* 
accurately,  in  finding  if  multiple  values  of  p_*  exist,  or  in  finding 
if  p_*  is  unidentifiable.   There  are  both  quantitative  and  qualitative 
measures  of  identifiability  which  can  be  applied  to  the  probleni  of 
finding  p_*  from  simulated  vehicle  data. 
N4. 3  MEASURES  OF  IDENTIFIABILITY 

The  identifiability  I  of  a  parameter  vector  p_  for  the  ocean 
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vehicle  mathematical  models  studied  in  this  thesis  depends,  as  in 
equation  N^.^,  upon  the  input  function  u,  the  starting  values  of  the 
parameters  p.  and  the  noise  parameters  Q  and  R.   In  order  for  I  to 
he  a  measure  of  the  difficulties  involved  in  finding  p_*,  it  must  in 
some  manner  be  a  function  of  the  characteristics  of  C  (pj ,  since 
the  minimization  of  C  is  the  goal  for  the  identification  of  p_*.   In 
the  Kalman  filtering  technique,  I  must  be  dependent  upon  those  final 
states  which  are  parameters  and  upon  their  final  error  covariances, 
since  these  determine  how  accurately  the  parameters  have  been 
identified. 

The  identifiability  of  a  parameter  is  a  measure  function  which 

* 

falls  into  the  general  category  of  sensitivity  functions  or  sensi- 
tivity analysis  in  the  area  of  control  theory  (S-3)  (R-10)  (D-10). 
Many  quantitative  sensitivity  measures  may  be  found  in  this  area 
which  can  be  applied  to  identifiability  studies  for  ocean  vehicle 
models,  but  such  formulations  have  not  been  investigated  and  are  not 
applied  in  this  thesis.  The  identifiability  studies  made  here 
represent,  for  the  most  part,  qualitative  analyses  of  the  model 
reference  contours  for  selected  parameters  and  a  qualitative  (percent- 
age) judgement  of  closeness  of  the  estimated  parameters  and  their 
error  covariances  from  the  Kalman  filtering  technique. 
N^  MOD.SL  REFERENCE  IDENTIFIABILITY 

The  model  reference  contouring  technique  is  the  primary  tool  for 
studying  identifiability  in  this  thesis,  and  the  system  modeler's 
interpretation  of  those  contours  leads  to  his  qualitative  judgement 
of  the  difficulty  involved  in  identifying  the  parameters  being  varied 
using  a  more  efficient  technique.   The  basic  considerations  applied 
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by  the  system  modeler  to  the  model  reference  contours  are  judgements 
with  regard  to  the  slopes,  shapes,  and  minimum  values  around  the  known 
or  true  values  of  the  parameters  used  to  generate  the  data.  These 
considerations  are  described  here  by  presenting  example  contours  of 
the  type  shown  in  Figure  N2.'^-  and  then  describing  the  identifiability 
characteristics  of  these  examples. 

As  discussed  in  Chapter  N2,  many  identification  techniques  repre- 
sent some  form  of  stepping  down  the  contours  of  the  cost  function  to 
the  minimum  value  of  C  (p_)  and  then  designating  that  point  as  p_*. 
Gradient  methods  step  down  these  contours  directly,  whereas  extended 
Kalman  filtering  steps  down  these  contours  using  the  known  or  , 
estimated  noise  characteristics  to  decide  upon  the  best  direction  and 
amount  to  step  at  each  contour.   Qualitatively  then,  identifiability 
(as  defined  in  Chapter  N^,2)  is  determined  by  the  ease,  speed,  or 
final  accuracy  with  which  these  methods  can  step  down  the  cost 
function  contours  generated  by  the  model  reference  contouring  studies. 
Most  of  the  qualitative  measures  discussed  here  apply  most  directly 
to  the  gradient  and  contouring  methods,  but  these  also  represent 
comparable  measures  for  identifiability  using  extended  Kalman 
filtering. 

The  applicable  identifiability  measure  will  usually  depend  upon 
the  identification  method  used.   In  the  case  of  a  first  order  gradient 
method,  the  most  identifiable  form  of  cost  function  is  given  by 
equation  N'l-,5  and  represents  a  perfect  absolute  linear  cost  function. 
The  plot  of  this  cost  function  is  shown  in  Figure  N^.2  and  would 
appear  as  a  cone  for  the  same  form  of  cost  function  contoured  in 
two  dimensions, 
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The  reason  that  this  absolute  linear  cost  function  is  considered 
the  most  identifiable  form  for  a  first  order  gradient  technique  is 
that  convergence  is  generated  in  one  iteration  step.   The  first  order 
gradient  iteration  technique  for  this  cost  function  is  given  by' 
equation  N^„68  and  the  applicable  gradient  is  given  by  equation  N4.7* 
When  these  two  equations  are  combined,  the  next  iteration  in  p  turns 
out  to  be  p*,  which  is  given  by  equation  N^,  8,   Thus,  no  matter  what 
initial  value  p  of  the  parameter  is  used,  the  method  identifies  p* 
in  one  iteration. 


Pn+1  =  Pn  "  C  ^n)/Cd  C  <pn)/d  pJ 


d  C  (pn)/d  pn  =  Sign  (pn)  -  lpn>0 

-1  p  <  0 
*n 


N4.6 
N^.7 


Pn+1  *  0  .  P-= 


N4.8 


The  primary  identification  method  used  in  this  thesis  is  model 
reference  contouring,  where  the  actual  identification  is  done  by 
the  observer  who  visualizes  the  contours  and  sees  the  minimum  value 
of  C  and  the  corresponding  optimum  values  of  p,  and  p  .  For  this 
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method,  the  most  identifiable  cost  function  is  a  "hole"  or  point 

displayed  exactly  at  the  optimum  as  given  by  equation  N4.9  and  shown 

in  Figure  N^.3»  This  cost  function  is  the  most  identifiable  because 

it  is  the  easiest  one  to  "see"  the  optimum  C  (p_*)  and  the  minimizing 

values  of  p  and  p?. 
1      c 


C  (pj  *  CQ  for  £  £   £* 
C  (pj  «  0  f or  £  ■  £* 
P2* 


Pi*" 


N4.9 


C=C 


C-0  at  center 


Figure  N^3  MOST  IDENTIFIABLE  C  (p.)  FOR  MODEL  REFERENCE  CONTOURING 


There  are  several  types  of  contour  configurations  which  may 
typically  be  encountered  in  the  use  of  model  reference  contouring  on 
an  ocean  vehicle  cost  function  C  (p,  ,  p_)  and  simulated  vehicle  data, 
The  identifiability  of  the  parameters  is  reflected,  in  one  way  or 
another  by  these  configurations,  and  the  system  modeler  can  use  this 
identifiability  knowledge  to  interpret  the  results  of  identification 
passes  on  real  vehicle  data.  Several  of  these  configurations  are 
listed  below  and  shown  in  Figure  N4.^. 

1.  both  p  and  p?  identifiable  and  independent 

2.  both  p  and  p  identifiable  with  multiple  values 

3.  p?  unidentifiable?  C  (p, ,  p2)  =  C  (p  ) 

4.  p  unidentifiable;  C  (p  ,  P2)  ■  C  (p2) 
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1»  both  p,  and  p2  identifiable 
and  independent 


2.  both  p  and  p_  identifiable 
vdth  multiple  values 
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3.  P2  unidentifiable;  C^,  p2)   4.   p  unidentifiable;  C(plf  p  ) 
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7*     linear  dependence; 
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Figure  N4.4-  TYPICAL  MODEL  REFERENCE  CONTOUR  CONFIGURATIONS 
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5.  P-,  hard  to  identify 

6.  p  hard  to  identify 

7.  linear  dependence;  p^  =  a  pp  +  b 

8.  functional  dependence;  p  =  f  (p  ); 

9.  partially  linear  dependence 
10.  partial  functional  dependence 

The  case  of  neither  p  nor  p  identifiable  would  be  a  blank  contour 
map  (not  shown)  or  a  map  with  completely  random  contours  (not  shown). 
In  some  cases  the  contours  of  Figure  N^,^  may  become  somewhat  un- 
certain or  "fuzzy"  because  of  the  stochastic  processes  v  and  w.   If 
the  shape  of  the  contours  remains  somewhat  the  same  for  significant 
amounts  of  v  and  w  noises,  then  the  system  modeler  may  be  fairly 
certain  to  be  able  to  identify  those  same  parameters  from  noisy  real 
vehicle  data. 

Qualitative  identifiability  studies  may  now  be  carried  out  using 
these  contours  and  their  interpretations.  Variations  are  made  in 
the  input  function  u,  the  ranges  of  p..  and  p  ,  and  the  noise  character- 
istics Q  and  R.   In  each  case  the  shape  of  the  contours  is  examined 
and  the  identifiability  of  the  parameters  determined  for  that  varia- 
tion. In  this  manner  the  system  modeler  may  eventually  learn  which 
inputs  u  make  the  most  identifiable  contours,  what  the  necessary 
ranges  for  p  and  p?  and  for  the  contours  must  be  in  order  to  deter- 
mine  p_*  to  a  desired  accuracy,  what  types  and  amplitudes  of  noises 
cause  the  parameters  to  become  unidentifiable  or  hard  to  identify, 
and  which  parameters  are  functionally  dependent  for  a  given  input  u. 
All  of  this  information  can  then  be  used  to  design  the  inputs  and  to 

interpret  the  results  of  identification  studies  for  real  vehicles. 
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Most  of  the  information  obtained  by  the  system  modeler  concerning 
identifiability  should  come  from  model  reference  contouring,  and 
then  the  actual  identifications  made  on  real  vehicle  data  should  be 
done  using  extended  Kalman  filtering.  Model  reference  contouring 
requires  a  great  deal  more  computation  (Chapter  N2)  in  many  cases 
than  does  extended  Kalman  filtering.   In  addition,  the  accuracy  of 
the  optima.1  parameters  or  their  steady-state  estimates  can  generally 
be  expected  to  be  better  from  the  extended  Kalman  filtering  technique 
than  from  model  reference  contouring, 
N4. 5  EXTENDED  KALMAN  FILTER  IDENTIFIABILITY 

There  is  some  identifiability  information  which  can  be  gained 
from  the  use  of  the  extended  Kalman  filtering  technique,  but  this 
information  is  more  of  a  "go  or  no  go"  type  than  that  obtained  from 
model  reference  contours.   Extended  Kalman  filtering  results  in  the 
state  trajectories  (including  parameters)  x(t)  and  their  error 
covariances  E  (t)  as  described  in  Chapter  N3.  In  the  case  of  un- 
identifiable or  functionally  dependent  parameters,  the  parametric 
states  in  x(t)  may  not  converge  to  steady -state  values  or  may  become 
unstable  and  increase  exponentially.   In  some  cases  the  states  may 
reach  steady-state  values  which  are  "biased"  away  from  the  true 
values  of  the  parameters;  and  at  the  same  time,  the  corresponding 
covariances  E  (t)  may  be  very  small,  saying  that  the  filter  has  a 
high  degree  of  confidence  in  an  erroneous  value  of  a  parameter. 
However,  many  of  the  cases  in  which  the  extended  Kalman  filter  will 
not  provide  proper  answers  can  be  explained  by  using  the  corres- 
ponding model  reference  contours. 
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In  later  sections  of  this  thesis  the  outputs  of  the  extended 
Kalman  filtering  process  are  displayed  a,s  plots  of  the  parameters  p  (t) 
and  their  error  covariances  E  (t).   Example  plots  of  a  parameter  p  (t) 
and  its  error  covariance  E  (t)  are  shown  in  Figure  N4.5«   The  final 


values  p„  and  E  on  these  plots  are  the  points  of  primary  interest 
from  the  standpoint  of  parametric  identification.  The  final  param- 
eter value  is  interpreted  as  a  gaussia,n  random  variable  with  mean  p 
and  variance  E  or  a  normal  random  variable  of  the  form  N  (p„,  E  ). 

The  identifiability  of  the  parameter  p  may  be  judged  from 
Figure  N^.5  by  how  closely  the  random  variable  p  »  N  (p  ,  E  )  corres- 
ponds to  the  known  value  of  p*  used  in  the  vehicle  simulation. 
There  are  both  quantitative  and  qualitative  judgements  which  can  be 
made  relative  to  this  correspondence.   Qualitatively,  if  p*  falls 
within  one  standard  deviation  af  of  p„  as  given  by  equation  N4. 9, 


N^.9 


P*  £   [p|  Pf  -  of  <  p  <  pf  +  crf] 

then  the  parameter  p  may  in  some  instances  be  said  to  have  been 
identified.  The  difference  between  p~  and  p*  is  termed  the  param- 
eter bias.   This  bias  will  certainly  have  a  significant  effect  upon 
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any  judgement  of  identif lability  for  the  parameter  p  and  will  usually 

be  expressed  as  a  percentage  of  p*.   The  identification  of  p  is 

highly  dependent  upon  the  initial  values  K  (p  ,  E  )  used  in  the 

o   o 

Kalman  filter,  and  some  qualitative  judgements  of  identifiability 
may  be  made  based  upon  how  much  closer  N  (p„,  E  )  is  to  the  true 
value  p*  than  N  (p  ,  E  )  was  prior  to  the  Kalman  filtering.  Often 
in  extended  Kalman  filtering  the  value  E  may  become  very  small  and 
indicate  a  much  greater  confidence  in  p  than  should  be  accepted  by 
the  system  modeler.   In  this  case  the  identifiability  judgement 
would  be  more  dependent  upon  the  bias  than  upon  the  one-standard- 
deviation  measure  of  equation  N4.9»   In  all  of  these  qualitative 
judgements,  the  system  modeler  must  know  how  close,  percentagewise, 
he  needs  to  identify  the  parameters  in  order  to  have  the  model 
represent  the  system.   This  information  is  provided  in  many  cases 
by  the  model  reference  contours. 

Quantitative  judgements  or  measures  of  identifiability  of 
parameters  estimated  as  states  by  an  extended  Kalman  filter  must 
reflect  the  closeness  of  the  state  estimates  p  to  the  known  value 
p*.  One  such  measure  is  suggested  here  as  a  possibility  and  is 
presented  in  equations  N4.10  through  N'l.14.  This  measure  is  the 

I*  =  p*2  +  a*s  n^.10 

O*2  =  0  N4.ll 

ip  -  (Pf  -  P*)a  +  k  (af  -  a*)2  M.12 

I   -  I  /i*  N4.13 

k   =1  N4.14 

normalized  vector  distance  (for  k  ~  l)  between  the  true  parameter 
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■p*  =   N  (p*,  o)  and  the  identified  value  p  ^  N  (pf,  E  ),  considering 
the  random  variable  as  a  vector  with  elements  pf  and  E~.  The  ident- 
ifiability  I  in  equation  M-.13  corresponds  to  equation  N4.4  and 
could  be  computed  using  different  inputs,  starting  states,  and  noise 
properties  in  an  attempt  to  minimize  it  for  the  ocean  vehicle  struc- 
ture and  the  extended  Kalman  filtering  technique. 

Another  possible  form  for  the  identifiability  measure  could  be 
the  integral  of  the  square  of  the  difference  between  the  extended 
Kalman  filter  estimate  and  the  true  value  p*  over  the  time  of  the 
filter  pass  as  given  in  equation  N^-,15.  This  measure  has  the 

I  -  ltf[p(t)  -  P*]3  dt  N4.15 

xo 

advantage  of  reflecting  the  complete  process  history  but  has  the 
disadvantage  of  not  including  any  information  or  measure  concerning 
the  error  covariance  E  (t).   Variations  of  the  dependent  variables 
in  equation  Hk,k   could  also  be  made  to  minimize  this  identifiability 
measure. 

The  extended  Kalman  filter  does  not  provide  as  much  identifiabil- 
ity information  as  do  the  model  reference  contours,  but  it  is  in 
many  cases  a  more  efficient  technique  to  use  for  the  actual  param- 
eter identifications.   The  extended  Kalman  filter  uses  the  noise 
characteristics  in  its  estimation  of  the  parameters  and  is  in  this 
sense  a  much  better  data  processor  than  model  reference  contouring. 
In  fact,  in  many  instances,  the  Kalman  filter  will  give  better 
estimates  of  the  pai'ameters  than  one  would  expect  possible  from 
looking  at  very  noisy  model  reference  contours. 
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Two  methods  for  identification  of  parameters  and  for  studying 
parametric  identifiability  have  been  presented  and  discussed  through- 
out this  section.  There  are  significant  difficulties  encountered 
when  model  reference  contouring  and  extended  Kalman  filtering  are 
applied  to  the  ocean  vehicle  mathematical  models  developed  in 
Section  M.  The  difficulties  encountered  in  applying  these  methods 
and  the  techniques  for  overcoming  these  difficulties  remain  to  he 
discussed  before  the  techniques  can  actually  be  applied  to  general 
ocean  vehicle  models  or  to  the  DSRV  model  used  in  this  thesis. 

N*U6  APPLICATION  OF  IDENTIFIABILITY  STUDIES  TO  OCEAN  VEHICLE 
PARAMETERS 

When  the  ocean  vehicle  mathematical  modeler  is  faced  with  a 
system  of  state  equations  as  complex  as  those  presented  in  the  general 
models  of  Section  Mf  the  solution  of  the  equations,  the  identification 
of  the  parameters,  and  the  making  of  judgements  as  to  whether  the 
mathematical  model  really  represents  the  system  may  appear  to  be 
impossible  tasks,  The  dimensionality  of  the  equations,  the  large 
numbers  of  parameters,  the  highly  nonlinear  form  of  the  equations, 
and  the  significant  uncertainties  of  the  process  a,nd  measurement 
noises  all  make  the  mathematical  modeling  of  a  specific  ocean  vehicle 
a  formidable  problem  unless  some  way  can  be  found  to  simplify  the 
problem.  For  sophisticated  vehicles  the  equations  will  be  nonlinear 
and  will  have  noise  inputs  regardless  of  the  simplifications  made, 
but  the  equations,  the  effectors,  and  the  parameters  may  be  capable 
°f  being  decoupled  in  several  different  ways  for  a  specific  vehicle 
model. 

This  decoupling  is  a  key  step  in  making  the  modeling  problem 

Solvable  and  must  be  utilized  whenever  6  degree  of  freedom  models 
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with  hundreds  of  parameters  are  analyzed  with  model  reference  contour- 
ing techniques.  The  extended  Kalman  filtering  technique  will  apply 
to  the  general  problem  but  may  require  an  unnecessarily  larger 
amount  of  computation  time  than  that  required  for  decoupled,  reduced 
problems.   The  manner  in  which  the  equations  of  motion  for  a  specific 
vehicle  decouple  must  be  determined  by  the  system  modeler  through 
analysis,  experiment,  or  simulation.   The  decoupling  of  the  equations 
will  facilitate  the  design  of  the  input  functions,  both  for  the 
simulated  vehicle  and  for  the  real  vehicle  sea  trials. 

Model  simplification  by  degree  of  freedom,  effector,  or  param- 
eter decouplings  requires  digital  computer  programming  for  either  a 
set  of  many  different  simplified  and  decoupled  mathematical  models 
or  for  one  total  mathematical  model  which  is  structure  selective  or 
capable  of  being  automatically  decoupled.   The  single  degree  of 
freedom  equations  of  Section  P  fall  into  the  first  type  of  model  set 
and  represent  one  type  of  model  which  would  be  required.  This  set 
of  models  would  have  to  have  many  two,  three,  four,  and  five  degree 
of  freedom  models  in  order  to  represent  totally  the  ocean  vehicle 
behavior  (specifically  for  DSRV),  For  small  numbers  of  parameters 
and  for  modeling  applications  in  which  great  precision  is  not  required, 
it  may  be  advantageous  to  develop  sets  of  decoupled  models  and  study 
the  parameters  of  each  individually.   Then  the  identified  parameters 
could  be  placed  in  the  total  model  and,  if  the  decouplings  were  valid, 
would  adequately  model  the  vehicle.  The  single  degree  of  freedom 
DSRV  equations  are  the  only  ones  of  this  type  developed  for  use  in 
this  thesis  (Section  P). 
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The  structure  selective  approach  is  the  one  taken  in  this  thesis 
and  is  the  one  suggested  for  any  6  degree  of  freedom,  multi -effector, 
multi-parameter  ocean  vehicle  v/hose  mathematical  model  mu^t  be 
identified  somewhat  precisely.  Structure  selectivity  is  little  more 
than  a  progra.mming  technique  in  vrhich  the  mathematical  equations 
are  solved  only  for  those  degrees  of  freedom,  effectors,  and  param- 
eters previously  selected  by  the  system  modeler.   In  this  technique 
the  system  modeler  specifies  the  number  KB  and  the  indexes  L  of  each 
of  the  degrees  of  freedom  to  be  used  in  the  model  (B~19).   Then  the 
digital  computer  program  for  solving  an  equation  such  as  M2.30 
reduces  to  one  for  solving  only  KB  equations,  and  the  summations  run 
only  over  the  KB  indexes  in  the  vector  L  instead  of  over  all  6  degrees 
of  freedom.  Similarly,  the  effectors  are  selected  as  to  their 
number  KK   and  their  indexes  LE;  and  the  parameters  are  selected  as  to 
their  number  KP  and  their  indexes  LP.  The  use  of  structure  selec- 
tivity requires  that  a  significant  amount  of  computation  time  be 
spent  selecting  the  degrees  of  freedom,  effectors t  and  parameters; 
but  the  method  pays  for  itself  many  times  over  vrhen  reduced  (decoupled) 
models  are  used  in  the  system  identification  techniques, 

, ,  As  examples  of  structure  selectivity  and  for  use  in  later 
sections  Table  K^-.l  presents  several  reduced  degree  of  freedom 
models,  their  indexes,  and  their  applicable  effectors  for  the  DSRV. 
It  is  rather  obvious  and  highly  fortunate  that  reducing  the  degrees 
of  freedom  of  the  model  also  reduces  the  applicable  effectors  and 
Parameters  very  significantly. 

The  system  modeler  begins  the  study  of  the  identifiabillty 

characteristics  of  the  particular  ocean  vehicle  of  interest  by  using 
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single  degree  of  freedom  models  (equation  M2.30)  and  the  applicable 
effectors  and  parameters  (Section  P  for  DSRV).  Simulations  are  made 
with  known  or  assumed  values  of  p_*f  and  then  the  identification 
techniques  are  used  to  find  p_*  again  from  the  noisy  simulated  vehicle 
data,  to  develop  the  best  vehicle  inputs  for  finding  these  parameters, 
and  to  learn  about  the  identifiability  characteristics  of  the  param- 
eters. This  process  is  then  continued  with  two,  three,  four,  and 
five  degree  of  freedom  selected  models,  selected  effectors,  selected 
maneuvers,  and  selected  parameters  (equation  M2.30).  At  some  point 
the  system  modeler  will  become  confident  enough  in  the  behavior  of 
the  model  structure  and  identification  techniques  to  specify  inputs 
for  a  full  scale  vehicle  or  physical  model  sea  trial.  Then  the  data 
from  the  physical  system  is  processed  using  the  same  structure- 
selected  models  as  were  used  on  the  simulated  vehicle  data.  The 
parameters  identified  from  the  real  vehicle  data  interpreted  in  the 
light  of  the  identifiability  studies  made  on  simulated  vehicle  data 
should  determine  the  proper  mathematical  model  for  the  real  vehicle. 
The  system  modeler  must  be  certain  that  the  measurement  structure, 
both  input  and  output,  used  on  the  real  vehicle  is  the  same  as  that 
used  in  the  identifiability  studies.  The  total  modeling  process  thus 
follows  the  flowchart  given  in  Figure  N^-.l  and  is  demonstrated  in 
this  thesis  for  the  DSRV  simulated  model  in  Sections  P,  D,  and  C. 

This  chapter  has  presented  the  details  involved  in  using  model 
reference  contours  and  extended  Kalman  filtering  plots  to  study  the 
identifiability  of  specific  ocean  vehicle  parameters.  These  details 
have  been  presented  in  the  framework  of  completely  general  defini- 
tions of  both  nodelability  and  identifiability  and  in  the  framework 
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Name 

Variables 

KB 

kT 

Comments  relative  to  DSRV  eff, 

surge 

u 

1 

[1] 

propellor 

sway 

V 

1 

[2] 

thrusters ,  shroud 

heave 

w 

1 

[3] 

thrusters,  ballast  tanks, 
shroud,  transfer  skirt 

roll 

p 

1 

w 

propellor  torque,  roll  tanks 

pitch 

q 

1 

[5] 

trim  tanks,  ballast  tanks, 
shroud,  transfer  skirt 

yaw 

r 

1 

M 

shroud,  thrusters 

surge , roll 

u,p 

2 

O] 

propellor  torque  coupling 

surge, heave 

u,w 

2 

[13] 

transfer  skirt  coupling 

surge, pitch 

u,q 

2 

[15] 

transfer  skirt  coupling 

sway, roll 

v,P 

2 

[24] 

transfer  skirt  coupling, 
splitter  plate  coupling 

sway, yaw 

v,r 

2 

[26] 

splitter  plate  coupling 

heave, pitch 

w,q 

2 

[35] 

secondary  drag  coupling 

roll, yaw 

Ptr 

2 

[46] 

transfer  skirt  coupling, 
splitter  plate  coupling 

horizontal  plane 

u,v,r 

3 

[126] 

all  effectors,  primarily 
propellor,  shroud 

vertical  plane 

u,w,q 

3 

[135] 

all  effectors,  primarily 
propellor,  shroud 

horizontal  roll 
coupling 

u,v,p 

3 

[124] 

all  effectors,  tanks,  prop. 

horizontal  plane 
with  roll 

u,v,p,r 

4 

[1246] 

all  effectors 

vertical  plane 
with  roll 

u,w,p,q 

4 

[1345] 

all  effectors 

Table  N4.1  SELECTED  REDUCED 

DEGREE  OF 

FREEDOM  MODELS  FOR  THE  DSRV 
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of  a  flowchart  for  "both  modeling  and  identification.  Host  of  the 
qualitative  identifiability  information  has  been  shovrn  to  come  from 
model  reference  contours  of  the  cost  function  changes  under  param- 
eter variations,  whereas  the  quantitative  identifiability  information 
resulting  from  extended  Kalrnan  filtering  has  been  shown  to  be 
measures  of  the  closeness  between  the  true  parameters  p_*  and  the 
identified  parameters  p_f.  Finally,  the  complete  modeling  steps  for 
ocean  vehicles  using  these  two  techniques  and  structure  selective 
models  have  been  described  in  detail  and  several  example  reduced 
degree  of  freedom  DSRV  models  were  given. 

This  section  has  presented  general  and  specific  definitions  of 
parametric  identification  problems  and  the  equations  of  model  refer- 
ence contouring  and  extended  Kalrnan  filtering  for  the  solution  of 
these  problems.  The  application  of  these  techniques  to  ocean  vehicle 
mathematical  modeling  and  to  the  equations  of  Section  M  has  been 
explored,  and  several  of  the  difficulties  involved  in  this  application 
have  been  discussed.   The  next  section  begins  the  actual  use  of  these 
identification  techniques  on  single  degree  of  freedom  equations  from 
the  DSRV  mathematical  model. 
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SECTION  k 

PARAMETRIC  IDENTIFICATION  OF  OCEAN  VEHICLE  DYNAMICS  (p) 

PI   THE  NATURE  OF  OCEAN  VEHICLE  PARAMETRIC  IDENTIFICATION 

P2   EXAMPLE  SINGLE  DEGREE  OF  FREEDOM  DSRV  EQUATIONS 

P3   MODEL  REFERENCE  STUDIES  OF  SINGLE  DEGREE  OF  FREEDOM 
DSRV  EQUATIONS 

Vk       EXTENDED  KALMAN  FILTERING  STUDIES  OF  SINGLE  DEGREE  OF 
FREEDOM  DSRV  EQUATIONS 


"A  BAD  BEGINNING  MAKES  A  BAD  ENDING."    EURIPIDES  (48M*06  B.C.) 


SECTION  M  PRESENTED  THE  STATE  SPACE  DIFFERENTIAL  EQUATIONS  FOR' 
MODELING  THE  DYNAMIC  MOTIONS  OF  OCEAN  VEHICLES.   SECTION  N  THEN 
PRESENTED  THE  MATHEMATICS  FOR  IDENTIFYING  PARAMETERS  IN  THE  NONLINEAR 
OCEAN  VEHICLE  EQUATIONS  USING  MODEL  REFERENCE  CONTOURING  AND  EXTENDED 
KALMAN  FILTERING.   THIS  SECTION  DESCRIBES  IN  DETAIL  THE  PROCESS  OF 
APPLYING  THE  MODEL  REFERENCE  AND  KALMAN  FILTERING  TECHNIQUES  TO 
OCEAN  VEHICLE  MODELS.   THIS  APPLICATION  IS  DESCRIBED  BY  USING,  AS 
EXAMPLES,  THE  SINGLE  DEGREE  OF  FREEDOM  DYNAMIC  EQUATIONS  FOR  THE 
DSRV.  MANY  RESULTS  OF  COEFFICIENT  AND  PARAMETER  IDENTIFICATIONS  BY 
BOTH  METHODS  ARE  PRESENTED  AND  DISCUSSED.   THIS  SECTION  IS  INTENDED 
TO  BE  AN  INTRODUCTION  BY  EXAMPLE  TO  THE  MORE  SIGNIFICANT  INDENTIFICA- 
TION  STUDIES  IN  SECTION  6  (C). 
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CHAPTER  PI 

THE  NATURE  OF  OCEAN  VEHICLE  PARAMETRIC  IDENTIFICATION 

Having  established  the  detailed  equation  structure  for  mathemat- 
ically modeling  ocean  vehicle  dynamics  in  Section  M  and  the  detailed 
equations  for  identifying  parameters  in  that  structure  in  Section  N, 
the  foundation  has  been  laid  for  the  development  of  total  ocean 
vehicle  mathematical  models.   This  section  presents  the  detailed 
steps  in  that  development  in  the  simplified  format  of  the  DSRV  single 
degree  of  freedom  equations;  and  at  the  same  time,  this  section 
serves  as  a  detailed  study  of  the  behavior  of  the  DSRV  coefficients 
and  parameters  in  the  six  uncoupled  degrees  of  freedom.   The  next 
section  (l))  then  presents  the  structure,  simulation  set  of  parameters, 
and  digital  computer  programming  description  of  the  DSRV  dynamic 
mathematical  model  in  six  degrees  of  freedom  with  structure  selectivity, 
complete  coupling,  effector  equations,  and  second  degree  coefficients. 
The  following  section  (C)  then  applies  the  identification  techniques 
to  some  selected  multiple  degree  of  freedom  DSRV  models  and  presents 
qualitative  descriptions  of  the  identifiability  characteristics  of 
selected  coefficients  and  parameters, 
n •!  OVERALL  MODELING  STEPS 

The  nature  and  specific  characteristics  of  ocean  vehicle 
parametric  identification  are  best  described  by  discussing  each  of 
the  steps  in  the  general  mathematical  modeling  process  for  such 
vehicles.   The  system  modeler  begins  with  a  vehicle  or  a  set  of 
vehicle  characteristics  and  proceeds  to  develop  the  structure  and 
initial  parameter  values  for  the  mathematical  model  as  in  block  2  of 

-1^4- 


Figure  Y\k,l,     The  structure  may  consist  of  an  equation  of  the  form. of 
either  equation  M2.30  or  equation  M3ell  with  the  effector  structure 
having  been  developed  specifically  for  the  given  vehicle.   The 
effector  structure  may  or  may  not  include  the  structure  and  parameters 
of  all  of  the  vehicle  control  systems,  depending  upon  whether  or  not 
the  effects  of  such  control  systems  can  be  decoupled  from  the  vehicle 
or  effector  structure.   These  beginning  structure  and  parameter 
specifica/tion  steps  are  very  important  to  the  overall  modeling  and 
identification  steps  which  follow. 

Once  a  set  of  structural  equations  and  initial  parameters  have 
been  specified,  simulation  studies  may  be  carried  out.  These  studies 
consist  of  Steps  Pl.l  through  PI .7  and  represent  parts  or  variations 
of  the  steps  in  blocks  3  through  10  in  Figure  N^.l. 


Overall 

Model 

ing  Steps 

Step 

Pl.l 

Specify  the  vehicle 

—&  Step 

PI. 2 

Design  and  run  a  sea  trial 

Step 

PI.  3 

Collect  input-output  data  from  the  sea  trial 

Step 

PI.  4 

Process  sea  trial  data  to  determine  vehicle  parameters 

Step 

PI.  5 

Decide  upon  adequacy  of  the  parameters  and  structure 

Step 

PI.  6 

Decide  upon  changes  to  be  made  in  the  structure  or 
parameters 

Step 

PI.  7 

Go  to  Step  PI. 2  and  continue  until  satisfactory 

modeling  is  achieved 

These  steps  can  now  be  discussed  in  more  detail  relative  to  the 

specific  problems  of  ocean  vehicle  parametric  identification  rather. 

than  the  total  problem  of  overall  mathematical  modeling, 
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PI . 2  SPECIFYING  THE  VEHICLE  TO  BE  STUDIED 

In  Step  Fl.l  the  vehicle  is  specified  in  detail  as  to  its 
structure  and  parameters  and  can  be  one  of  the  follovring:  the  actual 
full-scale  vehicle,  a  physical  model  of  the  real  vehicle,  or  a  prev- 
iously developed  mathematical- model  for  simulating  the  real  vehicle. 
The  full-scale  vehicle  is  the  most  expensive  specification  which  can 
"be  made  at  this  point,  it  is  the  hardest  to  vary  structure,  inputs, 
and  parameters  upon,  but  it  undoubtedly  gives  the  best  or  most  realistic 
data  from  a  sea  trial, 

A  physical  model  of  the  vehicle  may  be  used  at  this  point  and, 
in  general,  will  be  less  expensive  than  the  full-scale  vehicle.  For 
overall  dynamic  mathematical  models  the  physical  model  will  most 
likely  need  to  be  self-propelled  and  will  probably  need  an  elaborate 
measurement  system  for  the  acquisition  of  useful  and  realistic  data 
from  the  model  sea  trials.   If  it  is  desired  to  mathematically  model 
the  effectors  or  control  system  structure,  then  these  could  be 
physically  modeled  in  this  step  also.  The  data  acquired  from  physical 
models  can,  in  general,  be  expected  to  be  less  realistic  than  that 
obtained  from  the  full  scale  vehicle,  and  some  procedures  for  extrapo- 
lating or  scaling  the  results  of  physical  model  identifications  to  the 
full  scale  vehicle  must  be  developed  and  employed.  One  of  the  main 
advantages  of  using  a  physical  model  is  that  the  vehicle  and  mathemat- 
ical structure  and  the  input  functions  are  more  easily  changed  than  on 
full  scale  vehicles  so  that  many  more  runs  may  be  made  with  the  physical 
model  for  the  same  expenditures. 

In  the  case  of  the  specific  studies  in  this  thesis,  the  DSRV 

mathematical  model  is  specified  as  the  vehicle  in  this  step.   In 
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general  whenever  extensive  identifxability  studies  are  to  be  made 

in  order  for  the  system  modeler  to  increase  his  overall  understanding 

of  the  specified  structure,  the  mathematical  model  is  used  to 

simulate  the  vehicle  in  Step  Pl.l.   When  structure  selectively 

programmed  for  solution  on  a  digital  computer,  the  mathematical  model 

is  generally  the  least  expensive  and  the  most  flexible  way  of  specify- 

ing  the  vehicle  and  of  actually  making  simulated  sea  trial  maneuvers. 

The  main  disadvantage  of  a  simulated  model  is  that  the  data  generated 

may  be  far  different  from  the  real  vehicle  behavior;  however,  if  the 

initial  structure  of  the  model  has  been  properly  specified,  the 

primary  behavior  difference  will  be  due  to  different  parameters  in 

the  real  vehicle  than  in  the  simulation,,   If  identifiability  studies 

on  simulated  vehicles  show  that  the  parameters  are  identifiable,  then 

later  real  vehicle  data  may  be  analyzed  and  the  correct  parameters 

found  by  identification.   If  the  parameters  are  not  identifiable, 

their  input  or  structural  variations  may  be  indicated  along  with 

further  simulation  studies. 

EL. 3  THE  SEA  TRIAL 

The  overall  characteristics  of  the  sea  trial  in  Step  PI. 2  will, 

of  course,  depend  upon  the  vehicle  specified  in  Step  Pl.l.   The  primary 

consideration  in  designing  a.  sea  trial  to  be  used  in  sophisticated 

model  parametric  identification  is  the  fact  that  the  mathematical 

model  must  be  decoupled  or  broken  down  into  manageable  sub-models. 

Parameters  are,  in  general,  only  identifiable  if  they  are  in  some  way 

excited  by  the  vehicle  effectors  or  are  in  some  manner  coupled  into 

the  vehicle  equations  of  motion  for  a  specific  maneuver.   Thus,  the 

sea  trial  maneuvers  must  be  designed  to  excite  specific  parameters  of 
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interest,  and  the  model  structure  must  be  selected  specifically  for 
the  pertinent  effectors,  inputs,  degrees  of  freedom,  and  parameters 
being  utilized  in  order  to  have  any  chance  of  identifying  the  true 
parameters  from  noisy  data*   As  more  knowledge  is  gained  concerning 
parameter  identifiability,  and  as  more  confidence  is  gained  in  the 
values  of  the  parameters;  then  more  sophisticated  models  and  maneuvers 
are  employed.   In  this  manner  the  system  modeler  "bootstraps"  his 
way  upward  in  complexity,  understanding,  and  accuracy  until  the  full- 
scale  vehicle  is  adequately  modeled. 

For  preliminary  Identifiability  studies  the  sea  trial  should  be 
divided  into  blocks  of  time  during  which  specific  inputs  and  selected 
degree  of  freedom  models  axe  used.   The  data  generated  during  these 
blocks  is  then  used  in  the  model  reference  contouring  studies  with  a 
model  of  the  same  degrees  of  freedom  and  with  only  the  parameters  of 
interest  being  varied.  As  an  example  of  the  block  breakdown  for  a 
sea  trial,  Figure  Pl.l  shows  several  DSRV  sea  trial  blocks  for  the 
simulated  vehicle  using  some  of  the  models  in  Figure  N^-,1,   These 
blocks  need  not  be  run  in  this  order,  and  they  need  not  be  run  all  at 
once,  especially  in  the  case  of  a  siraula/ted  vehicle.  For  other  types 
of  vehicles  the  decouplings  to  single  and  double  degree  of  freedom 
models  may  or  may  not  give  valuable  information  relative  to  parameter 
identifiability. 

Once  the  sea  trial  blocks  have  been  specified,  then  the  inputs 

to  the  vehicle  may  be  designed  either  as  a  set  of  maneuvers  for  the 

real  vehicle  or  its  physical  model,  or  as  a  set  of  mathematical 

input  functions  for  the  simulated  vehicle.   The  primary  consideration 

in  specifying  an  input  for  the  purpose  of  identifying  a  parameter  is 
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Block  1 


Surge  (u)  model 


;  ■ 


Block  2 
Sway  (v)  model 
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Propellor  input,  Identify     Horizontal  thrusters  input, 


X   and  Propellor  thrust 
uu 

coefficient 


Identify  Y   and  H-Thruster 
vv 

thruster  coefficient 


Block  3 
Heave  (z)  model 


Block  4 


Vertical  thrusters  input, 


^|t  Roll  (p)  model ^ > 


'3  H 

Propellor  input,  Identify 


Identify  Z   and  V~Thruster   K   and  Propellor  torque 
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Block  5 
Pitch  (q)  model 


Block  6 
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Yaw  (r)  model 
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moment  coefficient, 
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Block  13^5 


Surge,  roll  (u,p)  model     Vertical  plane  with  roll 
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that  the  input  should  excite  the  system  dynamics  involving  that 
parameter  as  much  as  possible.  In  the  literature  (a-13)  (a-^)  (a  16) 
etc.,  an  input  of  this  type  is  designated  "persistently  exciting," 
has  a  precise  definition,  and  .is  shown  to  be  a  necessary  type  of 
input  for  certain  cases  of  linear  system  parametric  identification. 
For  nonlinear  systems  this  all  translates  somewhat  imprecisely  as  an 
input  function  -whose  Fourier  spectrum  contains  all  frequencies, 
especially  those  frequencies  at  or  near  the  natural  frequencies 
influenced  by  the  parameter  of  interest.   Step  functions,  impulse 
functions,  and  white  noise  are  examples  of  this  type  of  i input,  whereas 
single  and  multiple  frequency  sinusoidal  functions  are  not. 

Specifying  proper  inputs  is  extremely  important  to  the  process 
of  parametric  identification.  The  kinds  of  inputs  which  provide  the 
best  identif lability  for  parameters ,of  interest  may  be  determined 
from  simulated  vehicle  studies  and  model  reference  contouring.  In 
general,  the  proper  input  specification  is  more  critical  to  the 
extended  Kalman  filtering  technique  than  to  model  reference  contouring. 
For  a  given  ocean  vehicle  and  its  effectors,  the  kinds  of  Inputs  which 
may  be  used  will  be  constrained  by  the  physical  limitations  of  "the 
vehicle,  its  operators,  and  its  effectors  and  by  sea  states.   Thus,  inputs 
designed  for  simulated  vehicle  studies  should  reflect  these  limitations. 
P1  • **     INPUT-OUTPUT  DATA  COLLECTION 

Once  the  sea  trial  blocks  and  input  functions  have  been  designated, 
the  actual  sea  trial  may  be  conducted,  with  the  real  vehicle^  its 
physical  model,  or  its  mathematical  model;  and  the  input-output  data 
(u,  z)   for  the  parametric  identification  processes  may  be  collected. 
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The  sea  trial  data  for  the  real  vehicle  or  for  its  physical  model  Is 
usually  collected  by  some  form  of  measurement  system.   It  is  important 
that  the  structure  of  this  measurement  system  be  specified  (Chapter 
M3.l)  and  that  the  same  structure  be  used  in  the  simulated  sea  trials 
and  identifiability  studies  as  is  used  in  the  real  vehicle  or 
physical  model  sea  trials. 

The  parameters  for  the  measurement  system  may  theoretically  be 
identified  in  the  same  process  as  the  sea  trial  parameters.  However, 
if  it  is  at  all  possible  to  treat  the  measuring  process  as  a  different 
system  and  to  identify  its  parameters  separately,  then  some  effort 
should  be  spent  in  this  form  of  parameter  decoupling.  For  some 
vehicles  it  may  be  possible  to  transform  the  sea  trial  data  into  a 
form  directly  usable  by  the  parameter  identification  techniques 
without  affecting  the  identification  process  or  the  true  values  of 
the  parameters.   In  this  case  the  measurement  system  would  not  have 
to  be  included  in  the  simulation  studies. 

When  sea  trials  are  conducted  with  full  scale  vehicles  or  with 
physical  models,  the  input-output  data  is  usually  recorded  on  digital 
or  analog  magnetic  tapes.  For  the  case  of  the  simulated  vehicle  sea 
trial  this  data  may  be  recorded  on  magnetic  tape,  punched  cards, 
punched  paper  tape,  magnetic  disc,  high  speed  printer,  or  many  other 
devices.  In  either  case  care  must  be  taken  to  insure  that  the 
recorded  input-output  data  is  compatible  with  the  inputs  to  the 
identification  processes  and  with  the  computer  programs  used. 
EL . 5  PROCESSING  THE  SEA  TRIAL  DATA 

In  Step  PI, 4  the  sea  trial  data  is  used  as  the  input  data  for 

either  the  extended  Kalman  filtering  or  the  model  reference  contouring 
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techniques.  When  the  digital  computer  programs  are  set  up  to  include 
the  model  and  measurement  structure  and  the  initial  or  "best  guess" 
values  of  the  vehicle  parameters,  then  the  sea  trial  data  can  be 
processed  to  determine  the  parameters  which  were  used  in  its  genera- 
tion. Both  of  the  identification  techniques  utilize  multiple  passes 
over  the  sea  trial  data.   The  model  reference  contours  are  generated 
by  making  many  simulated  sea  trials  with  different  parameter  values 
and  comparing  the  outputs  at  each  pass  with  the  sea  trial  data. 
The  extended  Kalman  filter  may  be  run  many  times  over  the  same  sea 
trial  data  by  using  the  previous-pass  best  estimates  of  the  states 
and  error  covariances  as  the  initial  states  and  error  covariances  for 
the  next  pass.  The  outputs  of  these  processes  are  contours,  plots, 
and  numerical  values  which  may  be  analyzed  by  the  system  modeler, 
PI. 6  ANALYZING  IDENTIFICATION  RESULTS 

The  results  of  the  identification  processes  are  analyzed  in 
Steps  PI. 5 i  PI. 6,  and  PI.?  by  the  system  modeler  to  determine  whether 
or  not  the  parameters  have  been  identified,  whether  or  not  the 
identified  parameters  adequately  model  the  system,  and  what  changes 
are  to  be  made  in  the  modeling  and  identification  processes  before 
more  sea  trial  rims  are  made.   The  determination  as  to  whether  the 
parameters  have  or  have  not  been  identified  is  made  based  upon  the 
system  modeler's  understanding  of  the  basic  characteristics  of  the 
vehicle  behavior  and  upon  his  knowledge  of  the  identifiability 
characteristics  of  the  specific  parameters  of  interest.  Whether  or  not 
the  identified  parameters  adequately  model  the  vehicle  is  determined 
primarily  by  the  cost  function  or  closeness  value  for  that  set  of 

parameters  and  that  set  of  maneuvers  and  by  the  system  modeler's 
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criterion  of  that  value  of  closeness  for  which  he  may  call  the  vehicle 
adequately  modeled..   The  changes  which  must  be  made  in  tlrj  mode]  ing 
and  identification  processes  are  in  many  cases  indicated  by  the 
characteristics  of  the  output  contours  and  plots  as  interpreted  by 
the  system  modeler.  Many  of  the  detailed  considerations  for  analyzing 
identification  results  are  presented  "by  example  in  the  DSRV  studies 
of  this  section  and  of  Section  C. 

This  chapter  has  presented  an  overall  view  of  the  steps  used 
in  developing  mathematical  models  for  ocean  vehicles.  The  considera- 
tions used  by  the  system  modeler  for  specifying  the  vehicle,  breaking 
the  sea  trial  into  blocks,  designing  the  input  functions,  and 
utilizing  and  interpreting  results  from  the  identification  techniques 
have  been  briefly  describede   The  next  chapter  begins  the  detailed 
studies  of  the  DSRV  by  specifying  its  single  degree  of  freedom 
equations  and  conducting  preliminary  analytical  analyses  of  their 
behavior. 
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CHAPTER  P2 

"EXAMPLE  SINGLE  DEGREE  OF  FREEDOM  DSRV  EQUATIONS 

V/hen  five  of  the  six  degrees  of  freedom  in  the  mathematical 
models  of  Section  M  are  set  to  their  equilibrium  values,  the  resulting 
six  separate  models  are  called  the  single  degree  of  freedom  equations 
for  the  vehicle.   These  separate  equations  no  longer  truely  model  the 
behavior  of  the  vehicle,  but  a  great  deal  of  information  about  the 
vehicle  behavior  may  be  acquired  from  studying  them.   This  chapter 
presents  the  detailed  DSRV  single  degree  of  freedom  equations  and 
many  of  the  basic  considerations  which  may  be  applied  to  their  study, 
P2 e 1  DSRV  SINGLE  DEGREE  OF  FREEDOM  EQUATION  STRUCTURE  AND  PARAMETERS 
When  any  combination  of  five  of  the  six  primary  states  (u,  v,  w, 
p,  q,  r)  are  set  to  the  equilibrium  values  0,0,  the  resulting  equation 
form  is  essentially  the  same  for  all  cases  of  the  DSRV  and  is  given  by 
equation  P2.1.  For  the  case  in  which  positive  velocities  are  used, 

x  =  a  x  |  x|  +  b  u  |u|  P2.1 

this  equation  reduces  to  equation  P2,2,   Note  that  the  u  in  equations 

x  =  ax2  +  bu2  P2.2 

P2.1  and  P2.2  is  the  appropriate  propellor  or  thruster  revolutions 
per  second  and  not  the  vehicle  surge  velocity  and  that  the  gravity 
terms  in  all  of  these  equations  have  been  set  to  zero.   The  essential 
structure  of  equation  F2.1  is  that  of  an  object  of  unit  mass  being 
driven  through  a  fluid  with  absolute-square  drag  behavior  (Chapter  M3»3)r 
A  more  detailed  surge  equation  v.'ith  ux  coupling  is  given  by  equation  D3*13» 
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The  specific  DSRV  characteristics  for  these  six  single  degree 
of  freedom  models  are  presented  in  Table  12,1,   The  values  of  the 
parameters  a  and  b  in  Table  P2„l  are  those  values  used  in  the  sea 
trial  data  generation  and  the  values  of  u  (inputs)  represent  maxi- 
mum values  of  these  particular  effectors  used  in  the  sea  trial. 
The  steady  state  value  of  x  is  calculated  by  solving  equation  P2.3 
which  represents  the  equilibrium  solution  to  equation  P2,2  when  the 
inputs  are  set  to  their  constant  step-function  values, 

0  «  a  x|s  •!•  b  u2  P2.3 

The  value  of  an  approximate  equation  time  constant  "Y  may  be 
derived  by  linearizing  equation  P2,l,  with  the  input  u  set  at  its 
step-function  value  using  the  points  (x,  x)  ^  (0,  x  )  and  (x,  x)  = 

So 

(bu|u|  ,  0),   The  value  of  the  time  constant  for  the  linearized  system 
becomes  l/(ax  ) ,  and  the  linearised  equation  is  given  by  equation 

So 

P2,^,  The  value  of  6t  is  somewhat  arbitrarily  chosen  as  one-tenth  of 

x  -   ax   x  -i-  b  u2  P2.4 

ss 

a  time  constant.  The  large  number  of  trajectory  calculations  in 
model  reference  contouring  requires  that  the  time  steps  be  as  large 
as  possible  to  limit  computation  time, 
P2.2  EXAMPLE  OF  AN  EXTENDED  SINGLE  DEGREE  OF  FREEDOM  EQUATION 

The  equation  presented  in  equation  P2.1  is  the  simplest  structure 
possible  which  exhibits  the  essential  motion  behavior  of  the  DSRV, 
There  are  numerous  extensions,  still  in  a  single  degree  of  freedom, 
which  can  be  made  and  studied  regarding  this  structure.  An  example 
is  the  DSRV  roll  equation  which  is  extended  to  include  the  gravity 
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Variable 

u 

V 

w 

a 

X  /(m-XO 
uu'    u 

YvvA*"Yv) 

Z  /(m-zO 

A- 

ii 

-16.7 

-346. 

-207. 

i ,  name 

1 ,  surge 

2 ,  sway 

3,  heave 

(m-xi  ) 
xi 

4507. 

8683. 

7963. 

a 

-otoo37 

-0.04 

-0,026 

b 

0.168 

0.0011 

0.0012 

u-step 

1  rps. 

8  rps. 

8  rps. 

x  =u7-  J 
ss     a 

6.74  ft/sec 

1.33  ft/sec 

1.72  ft/sec 

T«l/a  x 

*K)  sec 

19  sec 

23  sec 

3T 

120  sec 

57   sec 

69  sec 

6t 

^  sec 

2  sec 

2  sec 

u~type 

propeller- 

thrust ers 

thrusters 

Variable 

P 

q 

r 

a 

4 

K  /(I  -K«) 
pp  v  x  p' 

-3.3*104 

M  /(I  -M.) 

qq'   y  q' 

-6.7-105 

N  /(I  -N*) 
-1.1*10* 

i ,  name 

^i,  roll 

5,  pitch 

6,  yaw 

(m~x|  ) 
i 
a 

4. 23*10^ 

8. 62*10 5 

8.6*105 

-0.78 

-0.78 

-1.3 

b 

0.0126 

0.00023 

0.00021 

u-step 

1  rps. 

8  rps. 

8  rps. 

ss  v  a 

.126  rad/sec 

.136  rad/sec 

,102  rad/sec 

T«l/a  x 

ss 

10  sec 

9  sec 

8  sec 

3T 

30  sec 

27  sec 

Zh   sec 

6t 

.5  sec 

,5  sec 

,5  sec 

u-type 

propeller 

thrusters 

thrusters 

Table  P2.1  CH 

ARAC'l'...'  ;;i';'i  \r.     c 

)F  DSRV  SINGLE  D 

SGREE  OF  FREEDOM  MODELS 
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and  angular  effects.   When  the  vehicle  angles  are  included  as 
state  variables t  then  the  DSRV  roll  equation  appears  as  the  two- 
state  system  given  Ivy  equations  P2C5  and  P2,6e      If  these  states  are 
combined,  the  second-order  nonlinear  differential  equation  P2,7  in 
the  roll  angle  <f   results  (for  a  simplified,  2-parameter  system). 

\ 


<P   -  P 

p  =  a  p  [pi  -}-  c  sin  if   -;•  b  u  j  u  | 


P2.6 


f  -  b,  <j>  \<f\   +   c  sin  y>  -  b  u  |u  |  P2.7 

Where:  c  *  0.W+  for  DSRV 

The  system  in  the  above  equations  is  a  perfect  example  of  what 
is  called  Newtonian  Damping,   The  characteristics  of  this  nonlinear 
differential  equation  are  discussed  in  detail  by  Struble  (S-8P  p.  20), 
where  the  properties  of  solution  existence,  uniqueness,  continuity, 
and  stability  are  all  shown  to  be  valid  for  this  set  of  equations. 
This  extended  single  degree  of  freedom  model  is  presented  to  show 
some  of  the  considerations  which  might  .be  necessary  in  studying  the 
single  degree  of  freedom  equations  of  a  general  ocean  vehicle.  The 
parameters  a,  b,  and  c  could  now  be  studied  for  their  identifiability 
characteristics  using  model  reference  contouring  and  could  also  be 
identified  using  the  extended  Kalman  filtering  technique. 
P2.3  ANALYTICAL  STUDIES  OF  SINGLE  DEGREE  OF  FREEDOM  EQUATIONS 

If  the  system  modeler  can  show  that  the  single  degree  of  freedom 
equations  for  his  specific  ocean  vehicle  are  well  behaved  in  a  mathe- 
matical sense,  then  he  has  some  degree  of  confidence  in  the  proper 
behavior  of  multiple  degree  of  freedom  models.   Precise  generalizations 
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cannot  be  made  in  this  respect  because  of  the  nonlinear  nature  of 
the  equations,  but  the  verification  of  the  analytical  properties  of 
these  multiple  degree  of  freedom  models  is  usually  much  more  diffi- 
cult than  for  the  single  degree  of  freedom  equations. 

The  homogeneous  portion  of  equation  P2.2  is  a  subcase  (a  ~  a?) 
of  the  more  general  homogeneous  nonlinear  differential  equation  P2.8, 
The  general  solution  to  this  equation  is  given  by  equation  P2.9,  and 
the  more  specialized  solution  for  a,  =  0  is  given  by  equation  P2.10, 

P2.8 


e                                                2 

x  ■  a-,    x  -j-  a,~  x 

x(t    )    =   X 

o'          o                      J 

x(t)  *  x     e^-^o) 
v   '         o 

P2e9 


1  +  xo  a2  [l-e^^o)]/^ 


y.\ 


(t)  =  *o  for  a1=0  P2.10 

1  -  xo  a2  (*-*? 

The  fact  that  the  derivative  dx/dx  is  continuous  means  that  equation 
P2.8  satisfies  the  Lipschitz  condition  (S-8)  (H-7).   This  guarantees 
that  a  solution  exists  which  is  unique  and  continuous  (Equation  P2.9). 
The  equilibrium  solutions  to  equation  P2,8  are  x  =  0  and  x  -  -a, /a  , 
For  the  cases  in  which  a-,<  0C  the  equilibrium  solution  x  »  0  is 
stable,  and  the  equilibrium  solution  x  «  -a^/a^  *-s  unstable e 

Another  analytical  consideration  is  one  which  applies  to  the 
nonhomogeneous  equation  P2,2  and  concerns  the  nonlinear  observability 
of  this  equation  when  expressed  as  a  state  estimation  problem.  This 
test  is  discussed  in  Chapter  M3»lt  is  developed  in  detail  by 
Schoenwa.ndt  (S~5)»  and  is  applied  to  equation  P2.2  in  Appendix  All, 
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The  results  in  Appendix  All  show  that  the  nonlinear  state 
estimation  problem  for  equation  P2e2  is  observable  and,  therefore* 
that  the  states  may  be  estimated  based  upon  input  ••'output  information. 
This  is  very  important  information  relative  to  the  utilization  of 
this  equation  in  an  extended  Kalman  filter.   The  nonlinear  observ- 
ability test  also  gives  useful  information  concerning  certain 
characteristics  which  the  input  function  must  have  in  order  that 
observability  be  possible.   In  the  case  of  equation  P2,2,  the  input 
cannot  be  zero  or  the  steady-state  step  value  of  u  for  the  states  to 
be  observable c 

As  one  might  expect,  the  application  of  the  nonlinear  observabil- 
ity criterion  to  any  but  the  simplest  equations  is  extremely  difficult. 
When  applicable,  however,  the  information  gained  relative  to  the 
observability  of  the  system  and  to  the  characteristics  of  the  input 
is  very  useful  in  modeling  and  identification  studies, 
K •  **  STOCHASTIC  SINGLE  DEGREE  OF  FREEDOM  MODELS 

The  single  degree  of  freedom  models  discussed  thus  far  in  this 
chapter  have  been  deterministic  and  have  contained  none  of  the 
structural,  input,  and  measurement  uncertainties  discussed  in  Chapter 
Kk,     The  structure  of  the  stochastic  models  for  the  DSRV  in  single 
degrees  of  freedom  is  given  by  equations  P2,ll  and  P2.12,  Note  that 


x  =  a  x2  +  b  u3  +  w 

P2.ll 

z    «*    X    +    V 

P2,12 

the  w  and  v  in  these  equations  represent  zero  mean  gaussian  white 

process  and  measurement  noises  and  not  the  heave  and  sway  velocities 
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of  the  vehicle.  Equations  P2.ll  &   P2.12  are  solved  discretely  using  v„  &  vr  . 

The  process  noise  w  appears  to  affect  the  system  in  a  completely 
linear  fashion,  but  in  actuality,  the  fact  that  the  state  variable 
x  is  squared  at  each  time  increment  causes  the  process  noise  to  enter 
the  system  nonlinearly.  The  measurement  noise  v  enters  the  measure- 
ments of  the  states  in  a  linear  fashion;  but  when  the  model  reference 
cost  function  is  calculated,  the  v  noise  is  essentially  squared  at 
each  time  increment.  The  fact  that  both  of  these  zero-mean  gaussian 
processes  are  squared  can  cause  biases  in  both  the  system  outputs 
and  the  identification  technique  outputs.   The  reason  for  this  is 
that  the  square  of  a  zero-mean  gaussian  random  variable  is  no  longer 
of  zero  mean  as  shown  in  Appendix  A10c 

In  later  studies  of  single  and  multiple  degree  of  freedom  DSRV 

parameters,  the  amounts  of  w  and  v  noises  are  expressed  as  percentage 

values  %v.   and  %v.     The  process  noise  percentage  %w   means  that  the 

standard  deviation  (a    =  VQ)  °£   Vf  ^s  that  percentage  of  the  maximum 

w         n, 

value  of  x  in  equation  P2.ll  for  a  step  function  maneuver  u„  The 
measurement  noise  percentage  %v   means  that  the  standard  deviation 
(o  =  Jfi)   of  v  is  that  percentage  of  the  maximum  value  of  x  being 
measured  in  equation  P2.12  for  a  step  function  maneuver  u.  These  are 
convenient  definitions  for  simulation  studies,  but  they  must  be 
interpreted  properly  for  a  given  maneuver.   If  x  or  x  is  at  a  small 
value  for  most  of  the  maneuver  and  then  assumes  its  maximum  value  only 
for  a  short  period  during  the  maneuver,  then  the  associated  vr  or  v 
noise  has  a  much  greater  effect  upon  the  overall  system  uncertainty 
than  it  does  if  x  or  x  is  at  its  maximum  value  for  most  of  the  maneuver. 
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This  chapter  has  presented  the  structure,  numerical  values  of 
the  parameters,  and  several  analytical  considerations  for  the  DSRV 

single  degree  of  freedom  equations  with  and  without  process  and 

measurement  noises.   These  equations  may  now  be  used  to  simulate  sea 

trials  for  the  simulated  vehicle  input-output  data.   This  data  may 

then  be  processed  for  parameter  identifiability  studies  using  model 

reference  contouring  in  the  next  chapter  (P3)  or  for  actual  parameter 

identifications  using  extended  Kalman  filtering  in  Chapter  P4. 
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MODEL  REFERENCE  STUDIES  OF  SINGLE  DEGREE  OF  FREEDOM  DSRV  EQUATIONS 

This  chapter  presents  an  in-depth  study  of  the  DSRV  surge 

equation  using  model  reference  contouring  and  varying  the  types  of 

inputs,  the  amount  of  process  noise  w,  and  the  amount  of  measurement 

noise  v.   The  next  chapter  presents  the  results  of  similar  studies, 

with  many  of  the  same  inputs  and  noise  levels  as  this  chapter,  using 

extended  Kalman  filtering.   In  this  manner  the  detailed  application 

of  these  techniques  to  simple  ocean  vehicle  models  is  explained,  and 

the  surge  parameters  for  the  DSRV  are  examined  to  determine  their 

identifiability  characteristics  relative  to  these  two  techniques, 

different  inputs,  and  different  noise  levels. 

The  exact  numerical  values  of  the  two  DSRV  surge  parameters  and 

the  specific  vehicle  and  model  equations  to  be  studied  in  this  chapter 

are  presented  in  Figure  P3«l»   The  reader  should  remember  the  values 

p?  -  -16.7  and  p*  =  755«  because  these  are  the  "true"  or  optimal 

parameters  used  throughout  this  chapter  and  the  nexte   The  results 

of  the  identification  studies  are  classified  and  presented  in  this 

chapter  by  the  propellor  input  function  types:   step,  staircase, 

crashback  full  astern,  impulse,  and  sinusoidal  of  different  periods* 

One  version  of  the  Fortran  IV  computer  program  is  presented  in 

Appendix  A12,  and  the  contouring  and  plotting  subroutines  used  are 

presented  in  Appendix  A5« 

P3.1  MODEL  REFERENCE^  SURGE  CONTOURS  USING  A  STEP  FUNCTION  INPUT 

Given  an  ocean  vehicle  to  test,  the  most  obvious  thing  to  do 

is  to  "turn  it  on  and  see  what  happens."  Let  the  DSRV  propellor 
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—"—-—-  __————————_____.  _________ 

Vehicle  (Simplified  as  a  2  parameter  system,  see  Equation  D3.13) 

m*  «  X*  x  1  x  1  + 'C*  u  | u  1  +  w 

uu    '   '     P 

z  =  x  -{-  v  ;  x(t  )  -  0 

2S                      \ 

A .        IJOli  V          I                  »->  .A 

numerically: 

4507.  x  -  -16.7  x  f  x|  +  755.  u  |u|  +  w 

_  -  x  +  v   ;   solved  discretely  for  8„  =  z(t  ) 

n    v  n' 

Where:  p*  -  X*u  -  -1.6.7  -  Surge  Drag  Coefficient 

p*  »  C*  -  755.  -  Propellor  Thrust  Coefficient 

m  ■  ^-507.  slugs  -  mass  of  the  DSRV 

k  -  gaussian  white  noise  -  N  (0,Q)  ;  discrete 

V  »  gaussian  white  noise  =  N  (0,R)  ;  discrete 

x  =  surge  velocity  in  ft/sec 

u  *  propellor  rotation  in  rev/sec 

Math.  Model 

ax  «  p]L  x  |  x  |  +  p  u  |  u  | 

z  -x  ;  x(t  )  -  0   ;   solved  discretelv  at  times  t 
m          0                               n 

Where:  p.  is  in  the  domain  [r>*   -  6  <  p.  <  p*  +  6~], 
1               u  i    —  i  —  i    J 

with  6  w  f  p*  ; 
i 

In  other  vrords,  vary  p.  approximately  +  50/°  of  p* 

B  -  ^507.  Slugs 

Figure  P3.1  DSRV  SURGE  EQUATIONS  AND  PARAMETER  VALUES 

input  u(t)  be  given  by  the  step  function  in  Figure  P3#2  for  the  sea 
trial  length  of  kfO   seconds,  With  this  input  and  the  computer 
program  of  Appendix  A12  a  simulated  sea  trial  may  be  computed  for 
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the  DSRV  in  surge.  A  plot  of  this  simulated  sea  trial  without  any 
process  or  measurement  noise  is  computed  "by  SUBROUTINE  PLOT  in 
Appendix  A5  and  shovm  in  Figure  P3.3»  Note  that  the  plot  is  read 
using  the  left  side  as  the  time  axis  and  placing  the  origin  in  the 
upper  left  corner  of  Figure  P3.3*  A  similar  plot  for  the  step  func- 
tion input  with  10$  v  and  10$  w  noises  (See  Chapter  P2.4)  is  presented 
in  Figure  P3.4, 


u,rps  ' 

i 

1.  - 

i   ^  j.  — 

0 

1    »'  o,  £>«*_; 

Figure  P3.2 

PROPELLOR  STEP  FUNCTION  INPUT 

With  a  step  function  input  the  DSRV  accelerates  from  0  to  6.7 
ft/sec  exponentially  in  about  90  seconds  for  a  drag  coefficient  of 
-16.7  and  a  propellor  coefficient  of  755°      If  the  mathematical  model 
is  now  used  with  the  same  input  and  different  parameters,  a  mathemat- 
ical model  sea  trial  can  he  generated,   If  the  output  of  this  sea 
trial  is  subtracted  from  the  vehicle  sea  trial  at  each  instant  of 
time,  and  the  result  is  squared  and  summed  over  the  sea  trial;  then 
the  resulting  value  C(p_)  (See  Chapter  N2)  is  generated  and  represents 
the  closeness  of  this  model  to  the  vehicle  over  that  sea  trial.   If 
these  C(p_)  values  are  generated  for  many  different  values  of  the 
parameters,  then  the  resulting  set  of  C(p)'s  may  be  contoured  to 
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FUNCTION  INPUT  AND  NO  NOISK 
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determine  the  identifiability  characteristics  of  p_.  The  contours 
for  the  step  function  input  of  Figure  P3,2  and  for  no  noise  using 
the  sea  trial  data  in  Figure  ?3«3  is  presented  in  Figures  P3.5  and 
P3.6. 


*•  v-     -'.'.    ■  -•  i  ':■  ■:'■■'-  •:■  •:  ---'r--'.  ■   ■  -   '  ■    '  ..:-■:;...•..  .  .-    .-  . 

CONTOUR  1       PARAMETERS 

*  X    RAi\3t?     :-0.2220E    02    TQ    -0.1070E    02    DX=    0.2500E 

*  Y    RANGE     :     C.555CE     )3    TJ       0.1055E    G4    DY=    9.  1000E    02* 

*  Z    CCN'AIN:     0.3729E-09    TU      0.4021E    04    DZ=    0.2011E    I 

*  Z    DOMAINS    FO!<    THE:    CONTOURS     :MAX    VALUES    FCR    EACH 

*  NOc     1    0.2011E    01     NO.    S    0.14C9E    04    NO.  1.5    0.2617E    04" 

*  NO*    2    0.2031E    03    NO.    9    0.1611E    04    N3.16    0.3O1J 

*  NO*    3    0.4C41E    J3    N0.1G    0.1812E    04    NO.  17    0.3219E    C4A 

*  NO,    4    C.6C52E    03    NO. 11    0.2013E    04    NC. 18    0.3420E    I 

*  NO.     5    0o6063E    03    NO, 12    0.2214E    04     ^0.19    0.3621E    (54* 

*  NOo    6    0.1007E    04    NO. 13    C=241dE    C4    N0.2C    0.3822E 

*  UO»    7    C.12C8E     Cm-    NO.  14    0.2616E    04    NO.  21    0.402  IE    C  4  • 

ji  sj  iji  .>•  4»  Jp4  '■'"■2"-  '-'  A  ,'    ■-"■  '  v  "  "'    :.■•''  .'       " 

Figure  P3.5  NUMERICAL  VALUES  OF  CONTOURS  IN  FIGURE  P3.6 


The  detailed  numerical-  values  are  automatically  printed  out  by 
SUBROUTINE  CONTUR  in  Appendix  A5  whenever  a  contour  is  generated,, 
In  Figure  P3«5  the  X-RANGE  corresponds  to  the  range  of  p, ,  and  the 
Y-RANGE  corresponds  to  the  range  of  p~.  These  detailed  values  of 
p.  and  p_  are  printed  along  the  edges  of  the  contour  with  X  running 
vertically  and  Y  horizontally  in  Figure  P3«6,   The  horizontal  values 
of  p2  are  set  such  that  the  last  number  in  the  exponential  corres- 
ponds to  the  numerical  value  for  that  *  location  on  the  axis.   At 
the  top  of  the  contour,  the  left,  center,  and  right  values  of  p*  are 
given  with  greater  accuracy  than  the  axis  values.   The  Z -DOMAIN  values 
correspond  to  the  minimum  and  maximum  values  of  C(p_)  over  the  contour. 
The  contours  in  Figure  P3.6  run  from  the  minimum  or  1 -value  to  the 
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maximum  or  M-value  in  linear  increments  of  DZ.  The  Z-DOMAINS 
descriptions  in  Figure  P3.5  correspond  to  the  21  numbers  and  letters 
1  through  M  used  in  the  contour. 

The  studies  in  this  thesis  required  that  large  numbers  of  plots 
and  contours  be  generated.   There  are,  of  course,  much  better 
methods  for  generating  contours  and  plots  than  the  printer  method 
used  here.  However,  the  author's  experience  has  been  that  the  sub- 
routines of  Appendix  A5  provide  a  cost  savings  factor  of  approximately 
10  when  compared  to  the  SC^020  or  CALCOMP.   Each  of  the  contours  and 
plots  in  this  thesis  along  with  many  others  not  in  this  thesis  were 

generated  at  a  cost  well  under  50  each.  The  author  hopes  that  the 

» 

reader  will  not  experience  too  much  conceptual  or  visual  trouble 
interpreting  these  plots  and  contours. 

The  reader  can  see  from  ?3o6  that  for  a  step  function  input 
the  cost  function  looks  somewhat  like  a  "trough"  running  upward  from 
left  to  right.  The  contours  here  look  like  those  of  contour  9  in 
Figure  N^.^l-,  and  show  that  for  a  step  function  input  p  and  p  are 
almost  linearly  dependent  in  the  form  of  equation  P3.1*  The  reason 

P2  -  -i|0  P;L  +  88  P3.1 

for  this  behavior  is  that  the  input  (step)  function  causes  x  to  be 
nearly  zero  for  most  of  the  sea  trial  at  the  steady-state  value  of 
x  «  6.7  ft/sec.   Substituting  these  values  into  the  vehicle  equation 
of  Figure  P3.1  gives  equations  P3.2  and  P3.3.   The  difference  between 

0  -  Pl  (6.7)3  +  P2  (l)2  P3.2 

P2  -  -45  P3  P3,3 
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equation  P3.1  and  P3»3  is  caused  by  the  dynamics  of  the  vehicle  jn 
the  first  90  seconds  of  the  sea  trial  in  Figure  P3«3  and  is  the  only 
reason  that  the  parameters  are  identifiable  in  Figure  P3.6, 

A  better  insight  into  the  shape  of  the  contours  in  Figure  P3.6 
may  be  gained  by  plotting  5  equally  spaced  vertical  slices  of  these 
contours  as  in  Figure  P3.7.   Here  the  numbers  1  through  5  represent 
these  vertical  slices  running  from  the  left  side  to  the  right  side  of 
Figure  P3.6.   The  most  obvious  characteristic  of  these  contours  is 
the  very  flat  minimum  along  the  bottom  of  the  trough.   In  the  case 
of  this  differential  equation,  the  flatness  is  caused  by  the  fact 
that  the  input  does  not  excite  the  dynamic  behavior  of  the  vehicle 
for  much  of  the  sea  trial.   This  means  either  that  the  parameters 
are  not  easily  identified  in  the  basic  model  structure  or  that  the 
input  function  is  not  exciting  the  vehicle  dynamics  enough  to  identify 
the  parameters.   It  is  highly  probable  that  small  amounts  of  noise 
introduced  into  the  vehicle  will  obscure  the  parameters  and  prohibit 
their  identification, 

When  the  same  contour  calculation  steps  are  used  with  the  10;S  w 
and  10^  v  noisy  sea  trial  data  in  Figure  P3«^»  the  resulting  contour 
is  shown  in  Figures  P3.8  and  P3.9»   This  contour  has  essentially  the 
same  shape  as  the  noiseless  one  in  Figure  P3«6t  but  there  are  some 
very  important  differences.   The  most  significant  difference  is  that 
the  minimum  values  of  the  noisy  contour  are  shifted  away  from  the 
known  "true"  values  of  -l6„7  and  755  to  the  values  of  -14.9  and  700. 
This  shift  is  most  likely  due  to  the  biases  generated  by  the  two  noise 
processes  and  has  the  effect  of  making  the  parameters  unidentifiable 
if  85/£  or  better  accuracy  is  required.   In  addition,  if  85$  accuracy 
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:■                                 CONTOUR         4       PARAMETERS  4 

*  X    RANGE    :-0.2220E    02    TO    -0.107CE    02    DX=    0.25C0E 

-    Y    RANGE     :     0.5550E    03    TO      0.1C55E    G4    DY=    0.1000E  02* 

*  Z    CCMAIN:    C.2729E    03    TO       Q.4314E    C4    DZ=    Co  2.0?  IE  C3* 

*  Z    DCMAINS    FOR    THE    CCNTOURS    : MAX    VALUES    FOR     EACE  * 

*  NO,     1    C.2749E    03    NO,    8    0.1689E    04    NO.  15    C.3104E  '  41 

*  NOo    2    C.4770E    0  3    NO.     9    0ol892E    04    NO. 16    0.33C6E  04* 

*  NOo     3    0o6791E    03    NO,  10    Q.2G94E     34    NO. 17    0.35C8E  14 

*  NO.t   4    0.8812E    03    NO.il    0.2296E     J4    NO,  18    0.3710E  04s 

*  NO*    5    0.1C83E    04    NO.  12    0.249  8E    04    NO. 19    0.3912E  0  4* 
=:;    NO..     6    C.1265E    C4    NO. 13    0.270OE    04    N0.2U    0.4114E 

*  NO.     7    C.1487E    04    N  G  o  1  ^    Co2902E    04    NO.  21    0.4314E  04* 

-:•  -.■        :  ?  V  b  i  $  "•?  ->  ',    - ■  ■";   •-:   ?  Nl  ;■  v  p  >s   'f  t  ?  v  ■  V ->  ^  3  •.:  M:V  !'  v    -  -.    V  -'       '  *    )j 

Figure  P3.8  NUMERICAL  VALUES  OF  CONTOURS  IN  FIGURE  P3.9 


is  acceptable,  then  the  closeness  of  the  model  to  the  vehicle  is 
C(e*)  =  2?3»  for  the  noisy  case  whereas  it  was  C(p_*)  -  0,  for  the 
noiseless  case,  compared  to  a  maximum  value  of  over  ^000  in  both  cases, 
Thus,  al  though  the  trough  has  remained  essentially  the  same  shape, 
the  bottom  has  been  raised  significantly  enough  to  somewhat  obscure 
the  true  values  of  the  parameters. 

The  contour  in  Figure  P3«9  shows  that  v  and  w  noises  greatly 
affect  the  identif lability  of  the  parameters;  the  question  then 
becomes  "For  a  step  function  input,  which  type  of  noise  has  the  most 
significant  effect  on  identifiability?"  It  must  be  kept  in  mind 
throughout  this  analysis  that  the  primary  effect  of  the  v  and  w 
noises  Is  to  make  the  optimum  p_  and  the  minimum  cost  function  values 
C(p_*)  into  random  variables  of  which  these  contours  are  samples. 
Contours  were  also  generated  for  the  cases  (v--0,  w^lO^)  and  (v=10/o, 
w--0),  and  the  essential  results  of  those  contours  along  with  the  two 
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previously  discussed  are  presented  in  Table  P3.1.   This  table  shows 
that  both  process  and  measurement  noises  have  significant  effects 
upon  the  identifiability  characteristics  of  the  parameters,  but  that 
v  noise  has  more  significance  for  C(p_*)  than  w  noise. 


Step  Input 

Pj(-16.7) 

P*(755) 

C  (£*) 

C  max 

Comments 

v--=0,  w=0 

-16.7 

755 

0.0 

4021. 

Trough  shape; 
Fig.  m.k  #9 

\M3,  w=10^ 

-17.9 

825 

11.6 

3902. 

Same 

v=10^,  w=^0 

-17.9 

805 

305.0 

A'390. 

Same 

v=10^f  w~10^ 

-1^.9 

700 

273-0 

4314. 

Same 

Table  P3.1  SURGE  EQUATION  IDENTIFIABILITY  CHARACTERISTICS 
FOR  A  STEP  INPUT"" 


The  detailed  plots  and  contours  for  the  step  function  input 
have  been  presented  here  to  show  the  reader  how  the  previous  identi- 
fiability considerations  and  the  numerical  values  in  Table  P3.1  were 
arrived  at.   For  the  remainder  of  the  studies  in  this  chapter,  only 
the  basic  noiseless  plots  and  contours  will  be  presented.   The  noisy 
plots  and  contours  will  be  described  in  tables  of  the  same  form  as 
Table  P3.1. 
P3.2  MODEL  REFERENCE  SURGE  CONTOURS  USING  A  STAIRCASE  FUNCTION  INPUT 

The  step  function  input  previously  discussed  only  excited  the 
dynamics  of  the  vehicle  for  90  seconds  of  the  470  second  sea  trial. 
The  staircase  function  input  in  Figure  P3.10  excites  vehicle  dynamics 
over  most  of  the  sea  trial  duration  and  proves  to  be  a  much  better 
identification  input  than  the  step  function.   The  DSRV  propellor 
takes  about  3  seconds  to  come  up  to  speed  (B~9) »  and  so  the  step  and 
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staircase  function  inputs  are  realistic  from  the  standpoint  of  the  40 
second  vehicle  time  constant  and  the  4?0  second  sea  trial. 


u,rps, 
1.0 


0.5 


0    100   200 


470 


-*>  t,  sec. 


Figure  P3.10  FROPELLOR  STAIRCASE  FUNCTION  INPUT 


The  resulting  noiseless  sea  trial  data  is  given  by  Figure. P3. 11 
and  the  noiseless  contours  are  presented  in  Figures  P3.12  and  P3.13* 


1 

■ 

*                                   CONTOUR          1       PARAMETERS 

•\ 

*    X    RANGF     :-0.2220E    0?    TO    -0.1070E    02    DX=    0„2500E 

0  0  * 

*    Y    RANGE     :    0.5550E    03    TO      0. 105  5E    04    DY=    0. 1000E 

02* 

*    7.    DOMAIN:    0.3228E-09    TO       0.11O5E    04    DZ=    0.5525E 

02* 

*    Z    DOMAINS    FOR    THE    CONTOURS     : MAX    VALUFS    FOP    EACH 

•}■. 

*    NO.     1     0..5525E    00    NO.     8    0.3873E    03    NO.  1  5    0.7741E 

03* 

*    NO.    2    0. 5580E    02    NO.    9    0.4426E    03    NO. 16    0.8293E 

03* 

*    NO.    3    0. 1111E    ^3    NO. 10    0.4978E    03    NO. 17    0.  8846E 

03* 

*    NO.    4    0.1663E    03    NO. 11    0.5531E    03    NO. 18    0.9398E 

03* 

*    NO.     5    0.2216E    03    NO. 1?    0.6083E    03    N0*19    0.9951E 

03* 

*    NO.     6    0.2768E    03    NO. 13    0.6636E    03    NO. 20    0.1050E 

04* 

*    NO.    7    0.3321E    03    MO. 14    0*7188E    03    N0.21    0. 1105E 

04* 

#:;>t •/:■>;: -&-.;:■:-:  ;':-     '^:  •?•>': -^  ^  J'.  s]:\]yf.%.k*< ~'\: +':>?.■,•,:  >>:  $$$ :':':']:  ■'/.  ■>■;.  -'-■•'■:  •■:  :'•■'■  ':  ;  •': -':  •'• -':  if. :' 

:** 

Figure  P3.12     NUMERICAL  VALUES  OF  CONTOURS  IN   FIGURE  P3*13 

The  contours  in  Figure  P3.13  shou  a  much  more  clearly  defined  optimum 
than  in  the  case  of  the  step  function  input  of  Figure  P3.6,   The 
staircase  input  is  designed  to  specifically  excite  "both  p  and  p  , 
The  first  tvro  steps  in  the  propeller  excite  the  equation  through  p? 
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Figure  P3.13     SURGE,    NO  NOISE,    STAIRCASE  FUNCTION  CONTOURS 
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up  to  200  seconds  into  the  sea  trial j  and  the  propellor  shutoff  at 
200  seconds  causes  only  p ,  the  drag  coefficient  to  be  in  the  dynamic 
equation  of  the  vehicle  until  the  end  of  the  sea  trial  at  470  seconds. 

A  large  number  of  identifiability  studies  for  different  noise 
combinations  were  conducted  with  the  staircase  input,  and  the  essen- 
tial results  are  shown  in  Table  P3.2.   There  are  several  conclusions 
which  can  be  drawn  from  this  table  relative  to  the  identifiability 
characteristics  of  p^  and  p^.   In  the  first  place,  the  parameters 
are  essentially  unidentifiable  (to  ±  50%)  for  v  or  w  greater  than 
20/o,  This  says  that  if  the  structure  or  measurements  are  20% 
erroneous,  then  the  parameters  cannot  be  identified  to  within  -t-  50% 


No. 

Staircas 

e  Input 

P*(-16.7) 

P*(755) 

C  (p*) 

C  max 

Comments ; 

Same  as  No* 

%v 

%w 

1 

0 

0 

-16.7 

755 

0 

1105 

Oval  Shaped 
Bowl;  Fig.N4.4 
#9;  2% 

2 

0 

1 

-16. 7 

755 

.41 

1091 

Same,  Slightly 
Larger  Min.  5% 

3 

0 

10 

-16.5 

730 

27 

1213 

Same,  Larger 
Minimum  10% 

4 

0 

100 

-22.2 

1000 

4048R 

5943 

Bowl,  Shifted 
Minimum 

5 

0 

200 

-22.2 

550 

7731R 

12750 

Fig  N4.4  #7 
Shifted  Min. 

6 

1 

0 

-16.7 

750 

1.5 

1072 

Same  as  #2 

7 

1 

1 

-16.5 

750 

2.18 

1093 

#2 

8 

1 

10 

-14.2 

700 

23,8 

969 

UZ 

9 

1 

100 

-22.2 

1050 

47'lOR 

6627 

m 

10 

1 

200 

-22.2 

660 

7163R 

10460 

#5 

11 

10 

0 

-15-9 

720 

282 

142] 

#2 

Tc 
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No. 

Staircase  Input 

P*(-16.?) 

P*(755) 

C  fc») 

C  max 

Comments : 

Same  as  No, 

%v 

^w 

12 

10 

1 

-14.7 

690 

242 

1305 

Same  as  #2 

13 

10 

10 

-18.7 

850 

354 

1457 

#2 

14 

10 

100 

-22.2 

550 

4079R 

9080 

#5 

15 

10 

200 

-22.2 

550 

12940R 

18380 

#5 

16 

100 

0 

-17.4 

550 

23470R 

25600 

#5 

17 

100 

1 

-10  c  7 

900 

22500R 

24790 

Reversed  Slope 
of  No.  5  above 

18 

100 

10 

-22.2 

730 

29780R 

33320 

Same  as  //4 

19 

100 

100 

-22.2 

1050 

32410R 

35190 

m 

20 

100 

200 

-22.2 

600 

28390R 

33490 

#5 

21 

200 

0 

-22.2 

950 

101600R 

104600 

//4 

22 

200 

1 

-22.2 

550 

77510R 

83280 

#5 

23 

200 

10 

-22.2 

550 

76700R 

81800 

#5 

24 

200 

100 

-22.2 

550 

103600R 

113600 

#5 

25 

200 

200 

-10.7 

550 

66830R 

67960 

m 

26 

2 

2 

-16.2 

750 

3.3 

1112 

tt\ 

27 

2 

5 

-16.7 

800 

8,2 

1044 

ii\ 

28 

2 

20 

-16.7 

700 

105.2 

1400 

#3 

29 

2 

30 

***^<C  c  £ 

970 

430R 

1765 

m 

30 

2 

50 

-20  e  7 

660 

821 

2890 

lr% 

31 

5 

2 

-16.2 

750 

3.0 

1089 

ft 

32 

5 

5 

-15.7 

700 

11.1 

1096 

#2 

33 

5 

20 

-12.7 

680 

84.8 

950 

#2 
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No. 

Staircase  Input 

P*(-16.7) 

P|(755) 

C  (£*) 

C  max 

Cora 

Same 

its  J 

as  No. 

c/oV 

%w 

34 

5 

30 

-22,2 

970 

466R 

1751 

Same 

as  //4 

35 

5 

50 

-22.2 

900 

958 

2456 

11 

m 

36 

20 

2 

-15*7 

700 

282 

1397 

11 

#2 

37 

20 

5 

-13.9 

680 

252 

1301 

11 

#2 

38 

20 

20 

-22.2 

960 

542 

1941 

H 

#4 

39 

2.0 

30 

-16.7 

550 

554R 

2510 

11 

m 

40 

20 

50 

-22.2 

930 

2925R 

5623 

11 

m 

41 

100 

2 

-17.7 

550 

23410R 

25600 

11 

//4 

42 

100 

5 

-10.7 

880 

22230R 

24450 

it 

#17 

43 

100 

20 

-22.2 

700 

29410R 

33170 

11 

#4 

44 

100 

30 

-18.4 

1050 

26390 

28290 

11 

m 

45 

100 

50 

-22.2 

900 

24-090 

26700 

ii 

m 

46 

200 

2 

-22.2 

950 

101800 

104900 

•1 

m 

4? 

200 

5 

-22,2 

555 

77350 

83120 

•1 

#5 

48 

200 

20 

-22.2 

555 

77010 

82130 

H 

#5 

49 

200 

30 

-22.2 

555 

98490 

106300 

11 

#5 

50 

200 

50 

-18.9 

1050 

63620 

64470 

it 

m 
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lative  M 

inimum 

accuracy  using  model  reference  contouring.   This  gives  some  indication 
as  to  the  importance  of  proper  model  structure  and  measurements  in 
system  identification,   Secondly t  the  larger  number  of  results  in 
Table  P3.2  than  in  Table  P3.1  gives  some  indication  of  the  randomness 
of  p*  and  C  (p_*)  as  the  noise  levels  are  increased.  Thirdly,  it  is 
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obvious  from  Table  P3.2  that  the  model  reference  contouring  method 

is  not  well  suited  to  extremely  noisy  (>  30%)   systems  because  the 

contours,  actually  random  variables,  are  only  seen  at  one  instant 

of  time  and  cannot  be  averaged  to  get  some  "mean"  of  behavior 

Finally,  this  table  shows  that  measurement  noise  v  has  a  much  more 

significant  effect  upon  the  value  C  (p_*)  and  the  identifiability  of 

the  parameters  than  does  the  process  noise  w  in  this  case. 

P3. 3  MODEL  REFERENCE  SURGE  CONTOURS  USING  A  CRASHBACK  FULL  ASTERN 
INPUT 

Whereas  the  staircase  input  was  designed  to  somewhat  evenly 

excite  both  the  p  and  p  dynamics,  the  crashback  full  astern  input 

is  designed  to  excite  the  entire  equation  with  a  large  transient  at 

the  center  of  the  sea  trial.   This  input  is  shown  in  Figure  P3.14 

and  the  noiseless  sea  trial  data  resulting  from  it  is  shown  in  Figure 

P3.15. 
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Figure  P3.14  CRASHBACK  FULL  ASTERN  INPUT  FUNCTION 


Since  more  vehicle  dynamic  motions  are  excited  by  this  input  than 
either  the  staircase  or  the  step  functions,  the  contours  can  be  expected 
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to  have  a  more  clearly  defined  optimum.   This  is  precisely  the  case 

as  seen  in  Figures  ?3.l6  and  P3„l?.   The  contours  in  this  case  are  "bowl" 
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Figure  P3.16  NUMERICAL  VALUES  OF  CONTOURS  IN  FIGURE  ?3,1?  ' 


shaped  with  a  fairly  flat  bottom  but  a  clearly  defined  minimum. 
There  is  no  longer  any  evidence  of  the  partially  linear  dependence 
which  was  found  in  the  case  of  the  step  function  input.   Several  of 
the  noise  behavior  characteristics  for  the  crashback  full  astern 
input  are  presented  in  Table  P3»3«   The  numbers  in  this  table 


Crashback  Input 

P*(~16.7) 

P*(755) 

C(£*) 

C  max 

Comments 

v=0,  w=0 

-16.7 

755 

0, 

1417 

Bowl   Shaped,    fiat 
bottom 

v«0,  w=10^ 

-17.4 

800 

20  . 

1387 

•i              ii 

v=10?o,  w=0 

-15.7 

700 

290. 

1875 

•i              ii 

v*xo$,  w=ao# 

-15.4 

850 

246. 

1190 

ii              n 

Table  P3.3  SURGE  EQUATION  IDMTIFIABILITY  CHARACTERISTICS  FOR 
A  CRASHBACK  FULL  ASTERN  INPUT 
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CONTOUR         1 
*•• 0  8*    INCREMENT    IS  0»5CC0(  3  2 

0.555CO0CE    03  0.8050.000E    03  !i0i!i,         |     04 

0.56E    C3       0.66E    03       C«  76E    C3       0.86E    C3       0»96        »3  04 

^COOO^^tJOC  •   ©    •   ©  ->^*^OOtO  v    O    U    v     ''    C    O    O    &  v    V    •   O  ft   •    •  0  -    O    i    & 

-0»  222E    02*88  8  £77  6* 66353  54444443333333333 3333334444444 55555*  I 
-0, 21 9 E    02 * 8  8  8  8  77666655554444  4  4  3  3 3 33 3  3  3  2  3  J  3  3  3  ?, 344444  4  4  555 

-  0 .  2 1 7  E   C  2  *  I  38777666555544 4 4 4 4 3  3 3 3 3 333333333333 3 4 4 h  4 h  4 4  5  5 

-0.  214E    02*8  8  8  77766655  5*4444433333  33  3  3  3333  33  33334  4444  44  55555  56= 
-C ,  21 2  F   02*8 3  8  776  6 6 5  5  5  5  4 4  4 44  3333333333  33333333 3 33 1 4 4  4445 5 5 5 i 
-0.  2  39 E    02  *88  7 776665 5  5 4444  4  33333333333  3  3 2  3  3  3  i  3  333 4 4  4  <i  4  4  5  5  5  5  5  <  6* 
-0.207E    02*63  77666555  44444  333  3  3  3333333  333333 333333444445555566' 
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indicate  approximately  that  10#  noises  still  permit  parameter  identi- 
fications to  within  about  10#  accuracy,   The  fact  that  the  contours 
remain  bowl  shaped  even  when  noises  are  added  indicates  that  this 
input  function  is  a  good  one  for  identifying  these  parameters  using 
model  reference  contouring.   . 

P3.4  MODEL  REFERENCE  SURGE  CONTOURS  USING  A  SIMULATED  IMPULSE 
FUNCTION  INPUT 

An  impulse  function  is  an  unrealistic  input  for  the  DSRV 

propellor  but  such  a  function  may  be  simulated  by  the  input  function 

in  Figure  P3«l80  This  input  function  excites  the  dynamics  of  p  very 


u,rps. 
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W 
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Figure  P3.18  SIMULATED  IMPULSE  INPUT  FUNCTION 


strongly,  but  only  for  the  first  100  seconds  of  the  sea  trial.  The 
dynamics  associated  with  p  are  in  effect  for  the  entire  sea  trial. 

The  sea  trial  which  results  from  the  simulated  impulse  function 
input  is  shown  in  Figure  P3,19,  and  the  resulting  model  reference 
contours  are  shown  in  Figures  P3„20  and  P3.21.   Several  of  the  noise 
behavior  characteristics  for  this  input  function  are  shown  in  Table  P3.^» 
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Simulated  Impulse 

P£(-16.7) 

P*(755) 

C     (£») 

C  max 

Comments 

v=0,   w=0 

-16.7 

755 

0, 

2808. 

Bowl  shaped,    flat 
bottom 

v=0,  w=10^ 

-16.7 

760 

28. 

2697. 

11                11 

v=lO%,   w=0 

-17.2 

755 

301. 

3338. 

11                11 

v=10$,  w»l0^ 

-15.9 

755 

329. 

29^2. 

•1                ii 

Table  P3.4-     SURGE  EQUATION  IDENTIFIABILITY  CHARA 

CTERISTICS 

FOR  A  SIMULATED  IMPULSE  INPUT 

The  contour  shapes  in  Figure  P3.21  are  quite  similar  to  those  for 

the  crashback  full  astern  input  in  Figure  P3.17.   This  indicates  that 

the  amount  of  dynamic  behavior  excited  in  each  case  is  about  the  same 

and  that  the  impulse  function  is  an  input  which  greatly  facilitates 

the  identification  of  p  and  p?.   The  noise  behavior  of  this  system 

1      /~ 

for  an  impuD.se  function  is  seen  to  be  much  better  than  that  for  a 
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crashback  full  astern  input.   This  is  due  partly  to  the  fact  that  it 
is  a  better  typo  of  input  function  and  partly  to  the  fact  that  the 
large  amplitude  of  x  in  Figure  P3.19  makes  the  10$  step  noise 
factors  behave  effectively  as  much  lower  percentage  noises, 
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nonlinear system parameter for the same noise percentages and for the 
best inputs. 

This chapter has presented in-depth model reference contouring 
studies of the DSRV surge equation. These studies vfere conducted 
using a variety of different inputs such as; step, staircase, 
crashback full astern, impulse, and sinusoidals of different periods. 
Of these inputs, the sinusoidal with a period near the "natural 
frequency" of the system v/as found to be the best for identification. 
Detailed noise studies showed in essence, that 10/5 v and v? noises 
allowed about 10^ identification accuracy for the tvjo sui’ge equation 
parameters. 

The next chapter presents several detailed studies and identifi- 
cations of the two parameters in the DSRV surge equation. As vfas 
done in this chapter, the parameters are studied for their identifi- 
ability characteristics using a, variety of different inputs. However, 
the identifiability of the parameters in the next chapter using the 
extended Kalman filtering technique is determined based upon the 
accuracy of the final parameter estimates rather than upon the shape 
and minimum values of contours, as in this chapter. 
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CHAPTER 



EXTL’NDHD KALMAN FILTERING STUDIES OF SINGLE DIgGKEi-] OF ERPilODOM D3RV 
equations 

This chapter presents the same types of analyses for the extended 
Kalman filtering identification technique as vrere described for the 
model reference technique in Chapter P3. The equations to be used 
in this section are those in Steps N3.9 through N3.l6 of Chapter H3, 
and one form of the actual computer program used is given in Appendix 
A14, The vehicle equations and parameters are the same as those in 
Figure P3.1 except that the parameters are augmented into the new 
state vector x as in equation P4,lj and the value of 6 is arbitrarily 
set at 6 « p|/4. 




in Figure P3.1 



P4.1 



The application of extended Kalman filtering to the DSRV surge 
equation is a much more critical task than vias the application of 
the model reference contouring technique. There are many factors 
which affect the behavior of the extended Kalman filter and determine 
both its rate and accuracy of convergence. One of these factor's is 
that for given amounts of process and measurement noises, expressed 
4y Qjj and R^, the values of the corresponding values Q and R which 
are used in the filter may need to be adjusted for the best filter 
convergence over the sea trial length. These Q and R values determine 
hovr the matrix E behaves and how large or small the Kalman filter gain 
matrix K becomes. 
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This chapter begins the presentation of the extended Kalman 
filtering studies by shovdng some trial runs made for the purpose 
of determining proper values for Q and R. Tlienj using these values 
the inputs are varied using the step, staircase, crashback full astern, 
simulated impulse, and sinusoidal functions as iias done in Chapter P3, 
Next, several studies are made using a longer sea trial length and 
varying the vadues of and sequentially to study their effects 
upon the filtering process. 

This chapter then presents some very dramatic filtering results 
vfhich vjere obtained by pi-operly "tuning" the filter by adjusting Q 
and R and concludes by utilizing the extended Kalman filter (eKF) on 
the remaining 5 single degree of freedom DSRV models in Table P2,l, 

P4.1 ADJUSTING THE VALUES OF Q AND R IN THE EXTENDED KALMAN FILTER 
Several extended Kalman filter runs were made with the staircase 
input, l^v and noises for the purpose of determining the effects 
of Q and R upon the convergence of the filter. The staircase input 
run using Q = and R R^ vdll be described in complete detail here, 
and then later runs vjill have only the results tabulated and comments 
made about them. 

The sea triad data to be used in the extended Kalman filter 

studies for the staircase input function, 3.%v, and l^w noises is 

shown in Figure P4.1,. This plot shows both the staircase input 

function (curve l) vfhich is the same as that of Figure P3.2 and the 

resulting noisy DSRV surge velocity (curve 2) which is similar to 

Figure P3.ll for the no--noise case. 

The surge curves calculated for use in the extended Kalman 

filter are slightly different from those used j.n the model reference 
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contours because the step size K for the filter is one-quarter of that 
used for the model reference studies. Tiiis means that four times as 
many points are generated, and Figure P^l-.l merely represents a plot 
of every fourth point. This is necessary because the dynamics of the 
parameters and the E matrix are somewhat faster than those of the 
surge velocity, and more precise integration must be used. It must 
be kept in mind tteoughout this chapter that the greater number of 
sea trial data points and extended. Kalman filter calcifLation points 
makes the noise percentages have a significantly greater effect than 
they did for the model reference contours of Chapter P3. 

The equations used for the sea trial data generation are repeated 
here as equations P4.2 and P4,3» The raaximu.m value of x during the 

4597. X == -16.7 X lx| + 755 u |u| -i- w P4.2 

z = X •{- V 5 ® P4.3 

sea trial is about 7 feet/second and so the standard deviation for 

l^v is chosen as 0.07, and becomes 0.0049; the corresponding stan- 

-6 

daxd deviation for l^v; is chosen as 1,7*10 ^ and becomes 2,89*10 . 

Using these equations and numerical vai-ues subroutine RKNL in 
Appendix A14 generates the noisy sea trial data, which is plotted 
in Figure P4.1, by Euler integration. 

Once the sea trial has been generated, then the extended Kalman 
filtering technique may be used to process the noisy data and. to 
identify the "unknown" parameters (-l6.7) and Pg (755) « The filter 
must be "told" initially what the best estimates of the sta,tes and 
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parameters are and be given their corresponding initial error co- 
variances or standard deviations, liic state equations to be used in 
the extended Kalman filter are given by equations P4.4 and P4.5 and 
the initial states and their standard deviations are given by equation 
P4,6, The initial values of the parameters are chosen at about 2.^% 



^1 




Xg x^|xi| •(- u|uj 


• 




0 


2 










0 



% - ^ 



x^(0) 




~1 + 0,7 ~ 


x^CO) 




-11.2/m ± 4,5/m 


X3(0) 




943/m ± 55A^ 



P4.4 



P4.5 



P4.6 

V/here: M = 450? slugs 



away from the true parameters and approximately one standard deviation 
in confidence. For this run the filter is told exactly hovr much noise 
is in the data by equations P4»7 and P4e8, 



Q = 0^ = 2.89*10"^ P4.7 

R « = 4.9*10"^ P4.8 



With this information the extended Kalman filter may be run in 
passes over the sea trial data in Figure P4,l, The filter of Steps 
N3.9 through N3.18 is implemented in this case by using the MAIN 
program and subroutines PROP, GAIN, UPDAT, and STORE in Appendix Al4. 
Each pass over the data generates six output plots (x(t), Pj^(t), 
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the filter estimates of the states and parameters over tlie length 
of the sea trial along with their corresponding estimated standard 
deviations. Successive passes are run using the final best erstimates 
of the states and parameters in the previous pass as the starting 
values for the next pass. 

The results of three extended Kalman filtering passes over the 
1^ noisy sea trial data in Figure P4,l ar'c shown in the 18 plots of 
Figures P^c2 through P4,19 o These plots show hovr the noise is 
filtered out of the primary state x (Figure P4, 2) and how the param~ 
eter values for (Figure P4,3) and (Figure P4, 4) are arrived at 
by the filter. The corresponding tine value of the standard deviations 
of the state c (Figure P4, 5) and the parameters o and o' (Figures 

X p^ Pg 

P4,6 and P4e?) are also shown. Tliis sequence of six plots is repeated 
three times, once for each pass over the data, in Figure P4, 2 
through P4,19. 

An enormous number of extended Kalman filter runs were made 
and the corresponding plots generated for the studies in this chapter, 
Ihe results of these runs v.'iD^l be described here in tabular form by 
listing the noise characteristics, the initial values, and the final 
values of the parameters for each pass. The tabular form for Figure 
P4,l through P4.19 is given in Table P4,l, The values at the end of 
each pass are talcen from the state and parametei' plots a.nd their 
corresponding standard deviation plots. 

The numbers in Table P4, 1 show that the filtered state estimates 

are biased about % away from the true values and that the standard 

deviations are extremely lovr. This indicates that the filter has an 

extremely high degree of confidence in these values of the parameters, 
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be decreased by "telling" the filter that there is more noise in the 

data than there actually is. This is accomplished by setting 

Q = 5Q and R - 5R » vihich has the effect of telling the filter that 
n n 

there is 2,2^ v and 2»2^ vr noises. The resu].ts of the corresponding 
extended Kalman filter run are shown in Table P4,2, 



q/r = 1. 


P^(-16,7) 


P2(755) 


Initial 


-11,2 + 4,5 


943 + 55 


Pass 1 


-16.3 + 0,2 


730 + 8,3 


Pass 2 


- 16,1 + 0.1 


709 + 6 


Pass 3 


-16,0 +0,1 


702 + 5 



Table P4,2 EKF, STAIRCASE, l^v, l^w, x^=lfl,7, Q=5Q^. R=5Rn 

The results of Table P4,2 eire essentially the same as those for 
Table P4,l except that the filter confidence in the parameter 
estimates has been slightly decreased, V/hat is happening in both 
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of these cases is that the extended Kalman filter E matrix for this 
nonlinear estimation problem is becomimg too small, too rapidly 
over the length of the sea trial causing high confidences in biased 
values. It is beneficial to recall at this point that in the model 
reference studies, v noise had a significantly greater effect on the 
contours than v; noise (Chapter P3.2), This suggests that the filter 
should be told that there is more v noise than there is w noise, or 
that q/R < 1, The results of Table P4-.2 suggest that both Q and R 

T(?0£. 

may need to be set significantly higher than the time noise amounts. 

As a result of these considerations the next run is made using 

Q= lOQn ^ ~ results of this run are shown in Table P4,3« 



q/R = 0,2 


Pi(-16.7) 


P,,(755 


Initial 


-11,2 


+ 4.5 


943 


i 


55 


Pass 1 


-17,1 


+ 0,6 


ON 

CO 




25 


Pass 2 


-16,8 


+ 0,4 


729 


+ 


18 


Pass 3 


-l6,6 


+ 0,3 


7l6 




15 



Table P4,3 EKF, STAIRCASE, l^v, l^w, Xp=lH_0.7, Q=10Qj^, R=50Rj^ 

The filter has been "slowed down" considerably in Table P4. 3 by 
the increased values of Q and R, The time value of p^ has been found 
to within \% and vrithin 1 standard deviation vrhereas the time value of 
is about % away from the identified value, Ibe error in p^ and 
the high value of the filter confidence are due partly to the fact 
that the initial confidence of 55 represented a reasonably high con- 
fidence in an erroneous value, Tlie values of the confidences in p^’and 
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in this table represent about y/o of the true parameter values for 
a case in which the noises are 1%. This suggests that the values of 
Q and R may be slightly large for the 1% noise case. 'Ihe next run 
is made using Q - 0^ ^ I'esults are shovm in 

Table P4.4, 



q/R = Ocl 


P;^(“16.7) 


P^(?55) 


Initial 


-11,2 + 4.5 


943 + 55 


Pass 1 


- 16.7 + 0,23 


7^^4 + 11 


Pass 2 


-16.6 + 0,17 


718 + 8 


Pass 3 


-16,5 + 0.14 


710 + 6 


Table P^.^I- 


EKF, STAIRCASE, 


l%v, x^-lj[p.7f 



In the run represented by Table P4.4 the filter was told that 
there were v and 1^ vr noises when in actuality there was 1% of 

each. The identification passes show that p^ is identified to 
within 1% mean vdth 1% standard deviation while p^ is biased avfay 
about 5^ with a 1% standard deviation. It is also evident from 
this table and from the previous three tables that the second and 
third extended Kalman filter passes really don't provide the signif- 
icant part of the identification of p^ and p^. Most of the identif- 
ication results for p^ and p^ are accomplished in one pass over the 
sea trial data for the DSRV surge equation. 

For the DSRV surge equation vdth a staii'case input, 1% noises, 

= 1 + 0,7, and 25 ^ erroneous initial values, the noise covariance 
values Q = and R = lOR^ are good values to use in estimating the 
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pai-ameters. Hovrever, this doss not necessarily mean that they are 
still good values to use when one of these major problem factors is 
changed. For a nonlinear state estimation problem sucli as this one, 
the filter must be "tuned" to each variation of the problem. 

There is one computational problem which is sometimes encountered 
when using the extended Kalman filter with small amounts of noise, 

Ibe E matrix rapidly approaches zero in the fiD.ter and may actually 
become negative due to computer or system noise. Negative E causes 
the E matrix propagation eq^uation to become unstable, and so some 
provision should be made to prevent this from happening or to correct 
it after it happens. One possible and somevrhat arbitrary correction 
procedui'e is given in Appendix A15, 

The next group of studies to be made with the extended Kalman 
filtering technique and the DSRV surge equation represent the same 
input function variations as used in the model reference studies of 
Chapter P3 and the fixed values of Q = a,nd R = input 

functions (step, staircase, crashback full astern, simtdLated impulse, 
and sinusoidal 100, 150, 300 » 500 ) vdll be used with the 1% and 10^ 
v and w noise combinations, and the results of 3 extended Kalman 
filter passes over each run will be tabulated, 

P4.2 EXTE?i[DED KALMAN FILTERING USING A STEP FUNCTION INFJT 

The step function input is shown in Figure ?3»2, and the results 
of the 1% and 10^ v and w combinations of noises using the extended 
Kalman filter are presented in Table P4-,5. These results essentially 
shovf that Vfo noises permit 1% identifications and 10^ noises permit 
10^ or better identifications using the step function input, A 
comparison of this table with the corresponding model reference resxdts 
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in Table P3.1 shons essentially the same results but with the KKF 
giving slightly better identifications in the noisy cases. 



Initial p^ 


-11.2 + 4.5 


Xq = 1 ± 0.7 


Q/R =0.1 




Values 


943 + 188 


P| - -16.7 


P| - 755. 




Noises 


l^Y 1 %W 


X^v XO^w 


XO^v X^w 


10%v 10'%\-i 


Pass 1 p^ 


- 16.9 + .11 


- 16.5 ± .33 


- 15.9 ± 2.5 


-14.5 ±2.2 


P2 


756 ± .07 


785 ± 13 


730 + 109 


757 ± 108 


Pass 2 p^ 


- 16,9 + .08 


- 16.5 + .28 


- 15.7 ± 2.1 


-14.2 ± 1.9 


^2 


757 ± .01 


785 ± 12 


718 ± 91 


739 ± 90 


Pass 3 P^ 


- 16,9 + ,06 


-16.5 ± .26 


- 15.7 ± 1.9 


-14.1 ±1.6 


P2 


757 ± .01 


784 ± 11 


712 + 80 


730 ± 78 



Table P4,5 EKF, STEP, 1% AND 10^ NOISES, Q«Q^, R=10R^ 



P4.3 EXTENDED KALMAN FILTERING USING A STAIRCASE FUNCTION INPUT 

The staircase function input is shown in Figures P3.10 and P4,l, 
and the results of several noise combinations (l and 10, 10 and 20, 

1 and 100 ) axe presented in Table P4,6, The initial values for 
Table P4c6 are the same as those in Table P4c5 repeated. 

The results of Table P4.6 show that 1% noises permit or better 
identifications, 10^ noises permit 40$® or better identifications, 20/b 
noises permit 60$^ or better identifications, and 100^ noises permit 
80% or better identifications. The two 10% v 10% vr cases are different 
because different noise starter integers were used in the noise 
generating subroutines. 

The results of the staircase input function identifications 
using the EKF are ourprisingl.y poor when compared with the step 
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function identifications and i^ith the staircase model reference 
identifications in Table P3.2, The primary reason for this is that 
the Vj^and vf^^noises enter the EICF at 4 times as many points because 
of the reduced step size, and -therefore these noises behave as the 
equivalent of about 4 times their actual percentages as determined 
from comparing Table P4.6 with Table P3,2, Thus the ’'modified" 
results are that k% noises permit identifications, k0% noises 
permit 40^ identifications, 80% noises permit 60% identifications, 
and 400?o noises permit 80% identifications. 

These modified results show that the filter behaves about the 

same for the staircase input as it d.id for the step function (unmod- 

( 

ified) and a.bout the same as the model reference results in Table P3»2, 
The results in Table P3s2 for the larger noise cases are somewhat 
misleading in accuracy because the pontours i;ere constrained to 
T parameter variations. The 60% and 80% identifications for the 
80% and 400^ noises arc possible because the filter is "climbing the 
wall" in Figure P3.13( vfhich is caused by the fact that as p^ 
approaches zero the surge equation approaches instability. The 
noise for large percentages causes such large biases that the vehicle 
never slovrs below 5 ft/seo over the staircase input sea trial. 

P4. 4 EXTENDED KALMAN FILTERING USING A CRASHB/^CK FULL AST ERN INPUT 
The crashback full astern input is shown in Figure ?3.l4, and 
the results of the 1% and 10% v a,nd vf noise combinations are presented 
in Table P4,7, These results show that for this input function 1% 
noises {k% modified) permit 10^ or better identifications and 10$^ 
noises (40??! modified) permit 20%> cr better identifications. These 
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Noises 


1%-A 


l%v 10%^■{ 


lO^v l%v 


IG'jiv lO^ii 




Pass 1 


-16.5 + .22 


- 14.0 + .44 


-15.4 ± 1.8 


-9.6 ± 1.6 




"2 


729 ± 9 


700 + 19 


730 ± 87 


630 ± 91 




Pass 2 


-16.5 + .1? 


- 14.0 + .31 


-15.5 ± 1.4 


-9.4 ± 1.0 




^2 


732 + 7 


699 ± 14 


719 ± 67 


600 ± 61 




Pass 3 P^ 


-16.6 ± .14 


- 14.1 + .25 


-15.5 ± 1.2 


-9.3 ± 0.8 




^2 


73 ^ ± 6 


698 ± 11 


715 ± 57 


590 ± 43 














Noises 


lO^v lO^w 


lO^v 20%v 


ZOfoV lOfoM 


20%v 20%» 




Pass 1 p^ 


- 22.6 + 2.1 


- 12.1 + 1.8 


-13.3 ± 2.5 


- 8.4 ± 2.2 




^2 


786 + 79 


683 + 96 


781 ± 134 


728 ± 135 




Pass 2 p, 
1 


- 24.2 + 1.8 


- 11.7 ± 1.3 


-13.0 ±2.1 


- 7.4 ± 1.5 




^2 


812 + 68 


652 ± 69 


738 ± 112 


630 ± 103 




Pass 3 P^ 


-25.1 + 1.7 


-11.5 ± 1.1 


- 12.8 ± 1.8 


-6.9 ± 1.1 




''2 


826 + 61 


641 ± 56 


714 ± 98 


585 ± 83 














Noises 


IfoV 1%\J 


l%v lOO^w 


100%'/ l%w 


lOO^v lOO^w 




Pass 1 p 


Same as 


— 6. 7 ± 1.4 


- 12.6 ± 4.0 


- 6.5 ± 3.7 




1 


Above 










^2 


It II 


6O8 ± 101 


912 ± 183 


969 ±183 




Pass 2 p^ 


II II 


-5.9 ± 1.1 


-13.5 ± 3.7 


-3.8 ± 2.5 




P2 


19 19 


539 ± 79 


894 ± 178 


935 ± 176 




Pass 3 p^ 


II It 


- 5.5 ± 0.9 


- 14.0 ± 3.5 


- 3.1 ± 1.6 




^2 


II II 


508 ± 67 


882 ± 174 


883 ± 168 




Initial Values Same as Table P 4, 5 






Table P 4.6 EKF, STAIRCASE, NOISE COMBINATIONS, 


0 = 0 ^, R= 10 R^ 
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Noises 


1%V 1%W 


l%v 10%vr 


10%v l%vj 


10%v 10%vf 


Pass 1 


-15.4 + ,14 


-14,5 ± ,24 


-15.3 ±1.3 


-14,5 ±1.1 


^2 


720 + 4 


701 + 8 


732 ± 44 


661 + 39 


Pass 2 p^ 


-15.4 ± ,10 


-14,6 + ,18 


-15.3 ±0,9 


-14.8 +0.8 


P 2 


721 ± 3 


704 + 6 


727 ± 32 


664 + 29 


Pass 3 


-15.3 ± .08 


-14,7 + ,15 


“15. 3 ± 0,8 


“I5.0 ± 0.7 


^2 


722 + 3 


706 ± 5 


725 ± 27 


666 ± 24 



Initial Vcilues Same as Table P4.5 

Table P4. ? EKF, CRASHBACK FULL ASTERN, 1% AND 10% NOISES , 

0=0^, R=10R^^ 



values are not as good as those for the model reference contouring 
technique in Table P3«3» but the "modified" noises again cause mis- 
leading conclusions. The fact that effectively noises permit 
Z0% or better identifications indicates that the EKF is at least as 
accurate an identification technique as model reference contouring 
for this input function. These errors might also be reduced by 
adjusting Q and R for this input or by using a better integration 
technique, 

P4.5 EXTENDED KALMAN FILTERING USING A SIMULATED IMPULSE FUNCTION 
INPUT 

The simulated impulse function input is shown in Figure P3.18, 
and the results of the 1% and 19^ v and vj noise combinations are 
presented in Table P4,8, These results shovr that 1% {h% modified) 
noises permit 25% or better identifications and 10% (40% modified) 
noises permit 30% or better identifications, using the simulated 
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Noises 


l%v Y/m 


l%v 10>cw 


10/^v l%v 


10/^v IC/^w 


Pass 1 P^ 


—1 3 « 0 + # 0 6 


-12.5 ± .08 


-14,7 ± 1.0 


-11,3 ± 0.9 


"2 


604 ± ,01 


604 + ,68 


676 ± 44 


583 ± 43 


Pass 2 p^ 


-13.4 + ,05 


-12,5 ± .06 


-14,7 + 0,7 


-11,3 ± 0,6 


^2 


608 + .001 


605 + .64 


673 ± 34 


576 ± 30 


Pass 3 Pj 


-13.6 + ,04 


-12,7 + ,05 


-14,7 ±0,6 


-11,3 ± 0,5 


^2 


6l0 + ,001 


605 ± ,63 


672 ± 28 


573 ± 25 



Initial Values Same as Table P4«5 

Table P4.8 EKF, SIMULATED IMPULSE, 1% AMD 10^ NOISES, R=10R^ 

impulse function input. The high degrees of confidence vfhich the 
filter has in the biased values indicates either that this is not a 
good input for the EKF or that the values of Q and R need to be adjusted. 
The identifiability characteristics of the EKF using this inpiut are 
far vjorse, even considering the modified noise behavior, than those of 
the model reference contouring technique in Table P3.4, 

P4,6 EXTENDED KALMAN FILTERING USING SINUSOIDxiL INPUT FUNCTIONS 

The input functions used in these runs were sinusoidal functions 
of amplitude and of periods 100, 150, 300, and 500 seconds. The 

results of multiple runs conducted with these four sinusoidal input 
functions are presented in Tables P4,9 through P4,12, The results in 
Table P4,9 for the sinusoidal ~100 second input functions show sorae of 
the problems which may be encountered vfhen using the EKF, For the low 
H noise cases in Tables P4,9 and P4,10 the filter dynamics were so fast 
that the Euler integrator, even with a step size of 2,5 seconds, could 
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not keep up. Also, it is evident that Q == is much too low for the 
filter whei'i using any of the four sinusoidal input functions of 
Tables P4.9 through P4^,12. 

The essential results of Tables P4.9 through P4.12 may be sum- 
marized in abbreviated form as follows; 



100 


second. 


10^ noises 


permit 


Z^% or better 


identifications 


150 


second, 


10^ 


• t 


II 


30 ^ 


II 






20^ 


M 


tl 


ko% 


It 






100% 


M 


II 


50% 


II 


0 

0 


second. 


1% 


fl 


II 


15 % 


II 






lOJo 


It 


II 


10% 


II 


0 

0 


second. 


1% 


M 


II 


10% 


II 






10% 


tl 


II 


20% 


II 



It may be expected that some of these figures could be bettered by 
readjusting the values of Q and R, by decreasing the integration step 
size and computing more points over the filtering process, by increasing 
the length of the sea trial, or by using a better integration method, 
such as Runge**Kutta, A comparison between these tables and the cor- 
responding model reference results in Tables P3»5 through P3,8 shows 
that for sinusoidal inputs the EKF is not as accurate as model refer- 
ence contouring unless the "modified" effects of the noises in the EKF 
are taken into consideration, 

P4, 7 EKF USING A LONGER SEA TRIAL, CLOSER INITIAL ESTIMATES. AND 
RUNGS-KUTTA INTEGRATION 

The operation of the extended Kalman filter is much more critic- 
ally dependent upon the input function, the initial state and parameter 
estimates, the values of Q and R, the length of the sea trial run, and 
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Noises 


l%v l^w 


1%-^ 


io;;^v i%vi 


lO^v lO^u 




Pass 1 


-17.7 ± 10“^ 


-14.0 ± .16 


- 13.4 + 1.3 


-11.8 ± 1.2 




^2 


605 + 0.1 


652 + .16 


719 + 29 


702 ± 28 




Pass 2 p 

1 


-26.0 + lo"^ 


-16.7 + .02 


- 13.3 + 1.0 


-11.7 ± 0.9 




h 


519 + 0.1 


610 + .12 


717 + 21 


701 ± 20 




Pass 3 P^ 


-38.6 ± 10”^ 


- 23,4 + .003 


- 13,3 ± 0.8 


-11.7 ± 0.7 




•■a 


417 ± .05 


525 ± 0.1 


?16 + 17 


701 ± 16 














Noises 


10%v lO^w 


lO^v 20^^1-f 


Z0%v 10%v! 


ZOfoV ZOfo\i 




Pass 1 p^ 


-14.5 ± 1.4 


-12.4 + 1.3 


-12.9 +2.1 


-11.1 ± 2.1 




^2 


714 + 30 


700 ± 29 


724 + 56 


692 ± 54 




Pass 2 p^ 


-14.2 + 1,1 


- 12.2 + 0.9 


-12.9 + 1.7 


-10.6 ± 1.6 




^2 


?14 + 21 


698 ± 20 


715 + 40 


684 ± 39 




Pass 3 P^ 


-14.1 +0.9 


-12,1 ± 0.8 


-12.8 ±1.4 


-10.3 ±1.3 




^2 


714 + 17 


698 ± 17 


712 ± 33 


681 ± 32 














Noises 


l^v 1%W 


l^v lOO^w 


lOO^v Ifow 


100%v lOO^v; 




Pass 1 p 


Same as 
Above 


-8.5 + 1.0 


-12.2 ± 4.0 


- 11.3 ± 4.0 




^2 


It If 


679 ± 30 


879 ± 161 


786 ± 159 




Pass 2 p^ 


It If 


-8.3 ± 0.7 


-12,7 ± 3.8 


-10.7 ± 3.8 




^2 


II It 


674 + 22 


845 ± 142 


692 ± 139 




Pass 3 


II If 


- 8.3 ± 0.6 


- 13.1 ± 3.6 


- 9.6 ± 3.6 




^2 


If If 


672 ± 18 


824 ± 129 


623 ± 124 




Initial Values Same as Tab! 


Le P4.5 






Table P4.10 EKF, SINUSOIDALj 150 SECOND PERIOD, 


R-IOR^ . 
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Noises 


\%V l^Vf 


l%v lO^w 


10?5v 


lO^v I0;^w 


Pass 1 p^ 


- 13.6 + .02 


-11.7 ± .02 


-12.7 +1.9 


-12.6 -V 1.9 


^2 


529 +0.2 


634 +0.4 


744 + 37 


733 + 37 


Pass 2 p^ 


- 70.8 + .02 


-27 + .02 


- 12.6 + 1.5 


- 12.6 + 1.5 


"2 


353 ± .07 


479 +0.2 


740 + 26 


734 + 27 


Pass 3 


-119 + .02 


-52 + .02 


-12.6 +1.2 


- 12.6 + 1.3 


^^2 


250 + .03 


329 + 0.1 


739 + 22 


733 + 22 



Initial Values Same as Table P4,5 

Table P4.9 E3(F, SINUSOIDAL. 100 SECOND PSRIOD 1% and 10% NOISES . 

Q-Q^, R=10R^ 





Noises 


l^v l^w 


\%v \Q%m 


lO^V \%M 


10%v lO^w 


Pass 1 p^ 


-14.3 + 0.1 


— l4. 7 + 0.2 


-14.6 + 1.0 


-14.0 +0.9 


^2 


653 + .02 


704 + 5 


700 + 33 


698 + 31 


Pass 2 p^ 


-14.3 + .07 


-14.7 + 0.1 


-14.7 + 0,7 


-14.1 + 0.6 


^2 


652 + .01 


704 + 4 


699 + 24 


699 + 23 


Pass 3 


-14.4 + .05 


-14,7 + 0.1 


-14.7 + 0.6 


-14.2 + 0.5 


P^ 


652 + .01 


705 ± 3 


698 + 19 


700 + 19 


2 











Initial Values Same as Table P4.5 



Table P4.ll EKF, SINUSOIRM, 300 SECOND PERIOD. 1% AND 10% NOISES . 
Q=Q,j, R=10R^ 

the speed and accuracy of the integration method than is the model 
reference contouring technique. The previous studies of this chapter 
have shovm that with slight preliminary 3 ,djustir.ents the EKF is nearly 
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I 




Noises 


l^v l?Sw 


l^V 10%M 


10/oV l%v; 


< 

0 


Pass 1 p^ 


-14.8 ± 0,1 


-14.9 ± .21 


- 15.4 + 1.1 


- 13.3 + 1.0 


^2 


66? + ,06 


688 ± 8 


703 ± 45 


616 + 41 


Pass 2 p^ 


-14.8 ± .07 


-14.8 + .15 


- 15.2 + 0.8 


-13.2 + 0.7 


^2 


665 + .03 


684 + 6 


697 + 32 


612 + 28 


Pass 3 


-14,8 + .05 


-14,8 + ,12 


- 15.2 + 0.7 


- 13.1 + 0.6 


P2 


664 + .02 


682 + 5 


695 + 26 


611 + 23 



Initial Values Same as Table P4.5 

Table P4.12 EKF, SINUSOIDAL. 500 SECOND PERIOD, 1% AND 10% NOIS ES, 
^-0^, R=10R^ 



as good as the model reference technique for low noise percentages 
and is a much better technique for high noise percentages. The fol- 
lowing studies will show that for a better integration technique, 
a longer sea trial, and slightly closer initial estimates the SKF can 
be made to operate as well as model reference contouring in the low 
noise percentage cases, 

A large number of EKF runs were made by the author using the 
staircase function input with Runge-Kutta integration in both the sea 
trial data generation subroutine and the EKF state and error covariance 
propagation subroutines. The sea trial time step was increased to 
H = 4 seconds, and the input function step times in Figure P3.10 were 
increased from 100 and 200 seconds, to 188 and 376 seconds respective- 
ly, The EKF was told that there was 2,2 times as much noise in the 
data as there was actually by setting Q = 50^^ ^ “ ^^n' initial 

values of p^ were specified to within 25% and one standard deviation, 
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and the initial values of vrere specified to v;ithin 10'^ and one 
standard deviation. The noise percentages used vrcre 5 ;^ v (ZOJ^ 
effectively) and 2^ v; (8^ effectively). The results of four of 
these runs are shown in Table P^I.13 for four different combinations 
of initial estimates. of the parameters. 

The EKF runs described in Table P4.13 show how remarkably well 
this filter can identify the DSRV surge parameters when it is properly 
"tuned" and when it has a good integrator. These numbers show that 
5^ V ( 20 ^ modified) and Z% vf (8% modified) noises permit or better 
identifications from any of four directions represented by the four 
different initial conditions vfhich are 25 ?^ and away from the true 
values initially. The Fortran IV statements for subroutines RKNL and 
PROP using Runge-Kutta integration are presented in Appendix AI 6 , 



Initial Q 


= 5Qj,. H = 4 


sec, , Staircase steps at 188 and 376 sec. 


Values R 




6 , - 50 , > 


= 1 +* 


= Runge-Kutta 


Initial p's 


3 f P2^800 


P2=-13,P2=700 


Pj^=-21 , P2=800 


P^=--21,P2=700 


Pass 1 p 

1 


—lb. 4 *1 0,9 


- 16.0 + 0,8 


- 16,5 +0,9 


- 16,0 + 0,8 


^2 


760 + 40 


715 ± 39 


OD 

0 


725 + 39 


Pass 2 p^ 


- 16.1 + 0.7 


- 15.9 +0.7 


- 16,2 + 0.7 


- 15.9 + 0,7 


^2 


750 + 34 


720 + 33 


753 + 34 


726 + 33 


Pass 3 P^ 


“16,1 +0,6 


- 15.8 + 0,6 


- 16,2 + 0,6 


- 15.9 ± 0,6 


^2 


738 + 30 


722 + 29 


742 + 30 


726 + 29 



Table P4.13 EKF, STAIRCASE, H=4, 5^v. 2/Sw, RUNGE-KUTTA , 
DIFFERENT INITIAL CONDITIONS 
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P4.8 SOME DHAHATIC EKF RESULTS V/ITH LARGE AMOUNTS OF NOT 5il.: 



When the noise percentages are increased, and the "tuned" filter 
of Table P4.13 is used; then the identifications of Table P4.14 are 
generated by the filter. The noises used here appear so evidently 



Initial p's 


P^ --- -13 ± 4,5 


P^ - 800 ± 64 


25%-v 25/^w 


-16,5 ± 1.7 


782 ± 61 


75%v 75 ^w 


-16,1 + 2.9 


791 ± 63 



Initial Values same as Table P4.13 except as noted 
Table P4.14 EKF, STAIRCASE, RIPIGB-KUTTA. LARGE NOISES 



in the sea trial data and are filtered out so dramatically by the EKF 
that the author decided to include the actual plots vrhich v;ere 
generated. The staircase input function and the sea trial data for 
the cases of ZS% and 75^ noises (v and w) are shovm in Figures P4,20 
and P4,24, The extended Kalman filter estimates of the vehicle surge 
velocity during the sea trial and of the parameters p^ and p^ are 
shown for these tv;o noise percentages in Figures P4,21 through P4.23 
and Figures P4,25 through P4,2? for the 2^% and 75^ noises respectively. 
In the mod.el reference contouring technique used in Chapter ?3, 
the actual identifier vras the "observer" of the contours. In Figure 
P4.24 for the 75^ noisy sea trial, it is practically impossible to 
"observe" even the vehicle behavior over the sea tx'ial, not to men- 
tion evaluating the mathematical model parameters. In fact, an 
observer might wonder whether or not there is any ocean vehicle 
behavior at all in the "hash" of Figure P4.24. A quick look at 
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Figure P4.20 SURGE SEA TRIAL DATA. 
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Figure P4.21 EKF SURGE VELOCITY ESTIMATES 
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Figures P4.25 through P4.2? reveals how dramatically the EKF picks 
out the DSRV surge velocity and the tv.-o vehicle parameters (especially 
p^). The reason that the filter can do this is that it has been 
given the exact absolute square law structure ( Equation P4,4) for the 
vehicle generating the data and it has been "tuned" to look for the 
parameters in this structure. 

For the DSRV surge equation the EKF is much more difficult to 
implement and tune than the model reference contouring technique, 
but once operational it allows remarkable identifications. This 
version of the filter may now be applied to the six individual single 
degree of freedom models of Table P2,l, 

P4,9 aCF RESULTS WITH DSRV SINGLE DEGREE OF FREEDOM EQUATIONS 

Six single pass identification runs ijere made vjith the EKF 
using each of the single degree of freedom models in Table P2,l for 
the purpose of proving that the v/orking of the filter v/as independent 
of the model degree of freedom used and of the values of the parameters. 
The results of these identifications are shown in Table P4,15 for 
the DSRV surge, sway, heave, roll, pitch, and yaw single degree of 
freedom models. The sea trials and identifications conducted in each 
of these reduced models correspond to Blocks 1 through 6 in Figure Pl,l, 
The prim.ery results indicated by Table P4.15 that the parameters 
are about identifiable for 2 >% noises a.nd that the EKF is a valid 
technique for each of the single degree of freedom DSRV models. 

This chapter has presented the results of a large number of 
extended Kalman filter identification runs for the DSRV surge equation. 
It has been found that not only must the filter be "tuned" to this 
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Common Factors: 


3" 53„ 


, R — Runge^Kutta Integration Method 




Degree 


%v 


%'A 


^0 


Effector 


Initial p^ 


Initia]. p£ 


H 


Surge 


5 


2 


1 +.5 


Prop, Irps 


-13+Jf.5 


800+64 


4 


Sway 


3 


3 


.l+.l 


Thr, 8rps 


-400+47 


8+1.5 


2 


Heave 


3 


3 


.l+.l 


Thr, 8rps 


-300+113 


8+1.4 


2 


Roll 


3 


0 


.01+. 03 


Prop, Irps 


-2, 5*io%i*io3 


600+73 


.5 


Pitch 


3 


0 


.01+. 03 


Thr. 8 rps 


-8*10%1.2*10^ 


100+86 


.5 


Yaw 


4 


0 


.01+. 03 


Thr, 8rps 


-1,5*10%1.5*10^ 


300+112 


.5 


Surge: 






4507 X 


= (-16.7 


) x|x| + (755 ) ii|u| 




Identified 


as 


4507 X 


= (-16.6 +10^- ) x|x| + (746+10"^ ulul 




Sway: 






8683 X 


« (-346 


) xlxl + (9,5 ) u|u| 




Identified 


as 


8683 X 


= (“323 +8 ) x|x| + (9. 1+0. 3) u|u| 




Heave: 






7963 X 


= (-207 


) xlx| + (9.5 ) ulul 


1 


Identified 


as 


7963 X 


= (-193 + 


;4 ) x|x| + (9.2jp.2) ulul 




Roll: 




4.23*10% 


= (-3.3*10^ 


) xlxl + (530 ) Ulul 





Identified as 4,23W^x ^ (-3.2*10^ ±570 ) x|x| + (525±8 ) ulu 

Pitch ! 8.62*10% = (-6.69*10^ ) x|x| + (193.6 ) ulu 

Identified as 8,62*10^x = (-6,5*10'^ +^,1*10^) x|x| + (185+3.1) u|u 

Yaw: 8.6*10^ x - (-1.12*10^ ) x|x| + (l8l,7 ) ulu 

Identified as 8.6*10^ x (-1.11*10%3.1*10% x|xl + (134+5 ) u |u 

Table Pi|-,15 EKF IDENTIFICATIONS FOR THE SIX DSRV SINGLE 
DEGREE OF FREEDOM MODELS 
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nonlinear differential equation by adjusting the values of Q and R, 
but a3.so it must have smaller time steps, more data points, and a 
better integration method than the model reference contouring tech- 
nique, However, once the filter is adjusted and given reasonably 
good initial estimates of the parameters, it is a far more accurate 
identification technique in the presence of large noise percentages 
than is the model reference contouring technique. In addition, the 
extended Kalman filter in its general form may be used for the identi- 
fication of many parameters at once, whereas the model reference con- 
touring technique looks at the parameters two at a time. 

This section has presented the detailed steps and results for 
the application of the techniques of model reference contouring and 
extended Kalman filtering to the ocean vehicle mathematical models of 
Section 2 (m) by using, as examples, the single degree of freedom DSRV 
equation of motion. Now that these techniques have been valida.ted 
for the single degree of freedom models, it may be reasonably expected 
that they vdll also work for more complex versions of the DSRV mathe- 
matical model. The next step is therefore to present the structure 
and parameters for a structure-selective DSRV mathematical model with 
any combination of six degrees of freedom or vehicle effectors and to 
develop the digital computer programs necessary to simulate the 
vehicle using this model. Section 5 (d) accomplishes this step, and 
then Section 6(C) uses this programming to study several selected 
coefficients ard parameters vising multiple degree of freedom models. 
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SECTION 5 



THE DSRV mathematical MODEL (P) 

D1 GENERAL OCEAN VEHICLE AND DSRV FORMULATIONS 
D2 OCEAN VEHICLE MODEL SUBROUTINE (OVMOD) 

D3 effector SUBROUTINES 

D4 general OCEAN VEHICLE AND DSRV GRADIENT FORMULATIONS 
D5 OCEAN VEHICLE DERIVATIVE SUBROUTINE (OVDER) 

D6 effector gradient SUBROUTINES 
D7 PROGRAM SIMPLIFICATIONS AND MODIFICATIONS 

A COMMEl'IT REGARDING COr-5PUTERS: 

’’DAZZLED BY THEIR /iBILITY TO DO ELEHENT/iRY THINGS AT IREMENDOUS 
SPEEDS AND TO PUT THESE TOGETHER IN STRUCTURES OF DAUNTING COM- 
PLEXITY, SOME HAVE AI.LOWED THE lERM ‘GIANT BRAINS’ TO, GAIN CURRENCY 
AND, SEDUCED BY THE SIREN SONG OF SO SENSELESS A SOBRIQUET, HAVE 
SURRENDERED THEIR BIRTHRIGHT OP RATIONAL THOUGHT FOR A POTTAGE 
OF PUNCHED CARDS." - R. ARIS (A-?) • 

THE CENTRAL PURPOSE OF THIS THESIS IS THE DEVELOPMENT, PRESENTATION, 
DSRV UmiZATION, AND ANALYSIS OF TECHNIQUES FOR THE IDENTIFICATION 
OF PARAMETERS IN AN OCEAN VEHICLE DYNAMIC MATHEMATlC/vL MODEL, THIS 
SECTION PRESENTS THE DETAILED EQUATIONS FOR ‘niE STRUCTURE SELECTIVE 
MODEL AND GRADIENT PROGRAMMING TO SIMULATE A GENERAL OCEAN VEHICLE 
WITH SUBROUTINES SPECIFICALLY TAILORED TO THE DSRV, THIS SECTION IS 
NECESSARY FOR THE UTILIZATION OF IDENTIFICATION TECHNIQUES ON THE DSRV. 
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CHAPTER D1 



r.ENSRAL OCEAN VEHICLE AND DSRV FORMULATIONS 

The purpose of this chapter is to provide a bridge between the 
general ocean vehicle mathematical models in Section 2 (h) and the 
specific DSRV mathematical model of the Lockhead Missiles and Space- 
craft Company (B-9). To do this, the LMSC model must be converted 
to state space form and broken up into additive blocks of coefficient 
and effector equations, llie resulting equations can then be seen to 
fit into the corresponding terms in equation Dl.l, vjhich is discussed 
in Section 2 (m), Tiie nomenclature for the terms and coefficients is 
standard and is defined in references (S-9) and (A-1), 

Ax « f(x,£) + feff(2L»li*E) + Gw Dl.l 

Dl.l THE DSRV DYNAMIC EQUATIONS 

The complete mathematical model for the DSRV is presented, with 
some varia,tions, in the three references: (B-9)» (T-1), and (B-2), 

Ibe equations to be used here are taken from (B-9), modified slightly, 
and presented here as equations Dl,2 through Dl,?, 



Surge 



m j^u -!• qvj - rv - xg(q^ -!- r^) -t- yg(pq - r) + Zq 
in- qw + X^y rv u [u] + X^.^ r"" + 

^rp ^grav ^sliroud ■*" ^prop ^thr ^ ^dist 




D1.2 



£3 



Sway 



m [v + ru - pw ~ -j- p''") -i- K(.(qr ■« p) •!• XQ(qp ... £’)j 

Y; ^ r + i) -I- Y^i^i r|u| + Y^^ pw Y^^ qp + 



+ 



Yv lul V |w| 4- Y , , p|u| + Y„ , , V luJ 4- Y 
^ P |u| \ |u| secondary 

^grav ^shroud \hr '** ^dist 



Heave 



m [w 4- pv - qu - Zg(p® 4- q®) 4- Xg(rp - q) 4- y^Crq p)] = 
Z;, w 4- Z^ 4 H- Zpp Zp^ pv Zp^ pr 4 - Z^^ V® 4- Z^,^ rv 4- 

^rr |u| ■*■ ^vflu] "H ^q juj ■*■ ^secondary 



^grav ^shroud ^prop ^thr ■''' ^dist 
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Roll 

m ^YqCvj 4- pv •• qu) ~ Zq(v 4- ru - pvr^ 4- Ij. p 4- ~ 

Iy)V- - P + V 4- qr -j- |^.,| v|w| 4- rw 4- 

Kvq + Sw P'' ^ lui -^^vM •‘■^plul P""' ■’• 

^iu| %]p| PlP| ■'■ ^grav S^^op ^dist 



Pitch 



m 



|^Z(,(ti 4- qw - rv) - Xq(w 4- pv - qu)j 4- I^q 4- - 



I )pr s M* 0 4- M« w 4- M pr 4- M |u| w 4- ^5 , , q |u| 4- 

2' q " w pr ^ |u|w q |u| ^ ‘ 

''■p + I . u ^i| M V® 4 M rv -h M r® •!• 
vp u |u| vv rv rr 



^^seconda.ry ^^grav ‘^shroud ^^rop ’’ ^thr ^ ^"‘dist 
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Yaw 

HI [xq(v ru - pw) - y^^(u + qw - rv)] + i r. + - l^)pq = 

N-, r -{- N; V -!- pq N |u| v + r |u| + wp -i- 

^vq ^ |u| ^ ^ |w| V '*' ^^secondary ''' ^grav 

^shroud ^prop '‘’ ^^thr *■' ^dist 

D1 . 2 m DERIVATIVE COEFFICIENT MATRIX AND PRIMARY DBRIVATIVBS 

Expanding equations D1.2 through Dl,? and collecting the deriva- 
tive terras leads to the vector x'epresentation in equation Dl,8, The 
derivative coefficient matrix A is then given by equation D1.9. 



u 




u® 


• 

V 




v« 


• 

w 


« 


u* 


c 

p 




p® 


• 

q 






• 




• , 


r 







- Ax s= X* 
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-x;) 


0 


0 


0 


mz^ 




0 


(m - Y^) 


0 


.(mzQ -i- Yj) 


0 


(ni>CG “ 


0 


0 


" 2^) 


hYg ■ 


-(mxQ + Z^) 


0 


0 


-(mzQ + K^) 


my^j 


dx - H) 


0 


0 


inzg 


0 


-(raxg -t- 


0 


(ly •' 1%) 


0 


-myg 


(mxQ - N^) 


0 


0 


0 


(I. “ N.) 

J- 



« A 
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The terns remaining in the expanded equations Dl,2 through JR. 7 
are designated the primed derivatives and correspond directly to the 
forces and moments acting on the DSRV, Biese terms are presented 
here for completeness as equations Dl.lO through D1.15. 

Surge 

lul ^ •* + 

Jnyg pq -!• (Xp^ - mzg) pr •!> + mx^) + 

(^rr + Vav \hroud '*■ ^prop 

^thr ^dist 

Swai 

v» 'i\u\y iu|v -I- Y|^|p |u|p + sign(u) - m) • 

^ ^v hi| (^vjp ■'* 

(Ypq " "’Xq) pq - mzg qr -f- my^ r^ -i- Yg^^ondary + 

^grav ■'■ ^shroud ^"prop ^thr ^dist Dl.ll 



H eave 

w* - Z-j |u| u|u[ + Z |u|w + (Z sign(u) + m) uq + 

Z^ V® + (Z^p - m) vp + Zy.^, vr + (Zpp + mz^) p® + 

(Zpr “ Jhxg) pr + mzg q« my^ qr 

^grav '*■ ^shroud ^prop ^thr ^dist 
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Roll 



i'' = |u|v -i- K|^|p |i).|p .j. ny^ uq -i- oien(u) 

rnzg) ur -t- K^,y| v |v| v |v;| ~ lay^ vp -t- vq •}- 

(K^^p - mz^) wp %|p| P|P| + (ly - Iz •«- \r) <3^ '''- 

*^grav ’^prop + ’^dist 

D1.13 



Pitch 

4* “ \|ul + J^luivr 1^1” + (J-’|u|q ^^Sn(u) - 

mX(j) uq + V® + (M^p -i- idxq) vp (m^^, + nzg) vr ~ 
mzQ Kq (Mp^ - + I^) pr + + ^secondary + 

*‘^grav ■*■ ^’^shroud ■*■ \rop ■*■ ^thr ■*■ ^^dist 



Yau 

i* “ »<|u|v N'' + » |u|p l“IP •'• (“|u|r ^^En(u) - 
Kg) m- + N^, |„| V |w| + vq - rayg vr + {N,,p + 

MXg) »p + Eyg .,q + (Np^ + - I^) pq H- + 

^grav ^^sliroud '*' ^prop "* ^thr '*' %ist 

Ul. e J~y 

D1.3 STATE SPACE FORM FOR TI{E DSRV EQUATIONS 

The general techniques for converting ocean vehicle mathematical 
models to state space form have been presented in Section 2 (m). The 
conversion of the DSRV equations Dl.lO through Dl«15 and D1.8 to 
state space form is a straightforuard application of those techniques. 
Thus, the terms u v i; p q r become the first six states in the state 
vector X. Since the DSRV model contains only second degree coeffi- 
cients and since an augmented state space model is desired, the 
second degree coefficients (126 of them at most) become the next 
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126 states in x. In addition, the fact that the reverse mode coeffi- 
cients are in sorrie cases different leads to the inclusion of the 
reverse node coefficients as the next 126 states. This last step is 
not essential if other provisions are made uithin the raodel to include 
the reverse mode coefficients. 

The vector x is now of dimension 258 by 1 and includes the 
vehicle linear and angular velocities and the vehicle forvjard and 
reverse node second degree coefficients. Had linear, third degree, 
or other coefficients been present in the model equations, they 
would have been augmented into the general state vector. 

For ease of computation the second degree coefficients were 
included in a special order running from through A general 

second degree coefficient can be represented as , vrhere k, i, 

and j run from 1 through 6 in correspondence v:ith u v w p q r and 

X Y Z K H N. In addition, some of the coefficients axe symmetric 

k k k 

in that X. . = X . . « Thus, one order in v;hich the X. . can be 
ij ji ij 

placed in x is in correspondence v/ith equation Dl,l6, 



(k, i, j) = i + - l)/2 + n(n -}■ l) (k ™ l)/2 n 

where: n = 6 D1.16 

The augmented state vector then appears as in equation Dl.l?. 

If in addition all of the vehicle parameters other than the states 

and coefficients are lumped into one parariieter vector £ , the 

bSRV equations are seen to be in the form of equation Dl.l. 

“1 T 

X = [u v w p q r X X rev ♦••N^^^.rev] 



Dl.l? 
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With the equations specified in this form and vfith the assumed 
or determined values of the coefficients and p?,ramctcrS( it is now 
possible to simulate a general ocean vehicle with the DSRV as a 
special case, Tne computations and structure selection are greatly 
facilitated by the state space form of the equations and by the 
coefficient computation order. 

Ibis chapter has presented the DSRV dynamic equations in state 
space form, Ihe detailed numerical values of the vehicle coefficients 
and parameters are presented in Appendix Al, The next chapter presents 
the programming details for calculating a general ocean vehicle state 
derivatj.ve x in a structure selective manner. 
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CHAPTER D2 



OCEAN VEHICLE HODliJL SUBROUTI NES (OVMOD) 

This chapter presents a programming description and a flo;/- 
chart for structure-selectively calculating x in equation Dl.l vdth 
and vdthout noise. This subroutine is very general in that by 
specifying inputs and by including proper input subroutines, a very 
large class of ocean vehicles may bo simulated. The Fortran IV 
statements for this chapter are presented in Appendix A6, 

D2.1 INPUTS A;ND OUTPUTS OF SUBROUTINE OVMOD 

All of the inputs and outputs of subroutine OVMOD axe either 
vectors or constants to permit variable dimensioning. Any numbers 
listed here are those used for the DSRV, 

OVMOD (ME, AV, XF, P, IN, U, NE, X, XN, XD, XDN, ICB, L) 

Inputs ; 

HE - Vector of 20 integers describing the vehicle effectors 
and parameter locations in vector P 

HE(i) - ME(9) “ Model selectox's of 0 or 1 depending upon 
ME(19) - ME(20) 

whether a particular effector- is not or is 
to be used. If 0, effector subroutine is 
not called 

1 - Tanks (TANKS) 

2 - Secondary d‘*'c'',g terms (sECAL) 

3 - Shroud (SHCAL) 

- Propellor (PRCAL) 

5 - Thrusters (THCjM) 
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m 



( 



I 

i 

i 



m 



r 



t 



J 









I 

/ 



i 



I 



l» 



< 



( 




/ 



1 

) 

I 



i ! 

! 

I 



20 

HS(IO) " HE(18) 
10 



6 - Kolse (XDIST) 

7 - Constant terms (COC/iL) 

8 " Center of buoyancy / 0 (GRAVT) 

9 - Koiselsss trajectory calculated in addi- 

tion to noisy one 

19 “ Vehicle ang3.es oxe integrated angalar 
velocities 

Vehicle angles are plotted as output 
Integer location of first effector' 
parameter in vector P 
Tanks 

11 - Secondary drag terms 

12 - Sliroud 

13 - Propeller 



72 

103 

229 

266 

560 

572 

578 

586 



14 - Tnruoters 

15 « noise 

16 - Constant 

17 ~ Gravitj»^ terms 

18 - General constants 
AV - Vector of 126 integers describing the absolute value 

characteristics of each of the second degree coefficient 
terms in the mathematical model in the order of equa- 
tion Dltl 6 ; see Appendix A2 
k 



XF - Vector of 126 integers designating second degree coeffi- 
k 

cient as a function to be evaluated instead of a 

constant and designating its functional branch in sub- 
routine XFUNS vfhich is used in subroutine XDCAL; see 
Appendix A2 

P - Vector of all vehicle and environmental parameters with 
initial locations specified by KE, total of 58? in DSRV; 
Appendix A1 

IN - Vector of integers to be used as starters for the noise 
generation subroutines (6) 

U - Vector of inputs to the ocean vehicle (18) 

U(l) - U(?) - Liquid loadings of the 7 tanics in Ibf, 

U(8) - U(9) - Shroud angles in radians (DP, DY) 

U(10) - U(n)- Fropellor RPS and RPS/SEC (n, n) 

U(l2) - U(l5)“ Ihrusters RPS (yf, ya, zf, za) 

U(l6) •* U(18)- Vehicle Angles (PHI, THETA, PSI) 

NE - Vector of integers describing the number of each type of 
input and its location in input vector U and describing 
some effector parameter group characteristics in P 
NE(1) HE(10) - Number of types of effectors and loca- 

tions in input vector U 

1 - Tanks (?) 6 - Tanks location (l) 

2 - Shroud (2) 7 - Shroud location (8) 

3 - Propeller (2) 8 - Prope location (lO) 

4- - 'Hirusters (4) 9 - Ibr. location (12) 

5 - Angles (3) 10 - Angles location (l6) 
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ME(11) “ »IE(27) ** Nurabex' o£ sli’a.i{^lit. lint I'egions in the 

parar.etric descriptions of the shroud 
and thrusters 

11 - Shroud lift regions (5) 

12 - Shiroud drag regions (lO) 

13 •• 18 Thruster regions (8, 8, 3, 5, 7, 7) 

19 - Noise parameters (6) 

20 ~ Shroud lift derivative regions (9) 

21 “ Shroud drag derivative regions (15) 

22 *• 27 - Tnruster derivative regions (ll, 9» 5» 

9 , 10 , 9 ) 

X - Vector of all vehicle states and augmented forcward and 
reverse mode coefficients, noiseless (258), Appendix A1 

XN - Vector of all vehicle states and augraented foreuard and 
reverse mode coefficients, uith added and integrated 
noise (258) 

KB - Integer 1 < O < KS describing the number of states in the 
model structure, KS « 6 for DSRV 
L - Vector describing the individual states (total of KB) in 
the model structure 

OUTPUTS ; 

XD - Vector of primary state derivatives selected by KB and L 
without noise (maximum of 6) 

XDN ~ Vector of primary state derivatives selected by KB and L 
with added and integrated noise (maximum of 6) 
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D2.2 PROGRAMMING DESCRIPTION AND FLOHCHART OF SUBROUTINE OVKOD 



The purpose of subroutine OVMOD is to calculcvte the noisy and 
noiseless state derivatives, x and ^ , in a structirre selective 
Banner. Thus, subroutine OVMOD solves equation D2.1, v/hich represents 
a large class of ocean vehicles. Equation D2.1 is a subcase of 




equation Dl.l, The summations may also be written j ■=■ 1, 6 and 
i «= 1, j, Tne structure selective aspect of solving equation D2.1 
comes from allowing i, j, and k (where x = xj^, k = l, 6) to take on 
only the values of the desired model. 

The programming necessary to solve D2.1 structure selectively 
begins vrith the establishment of the center of gravity, weight, 
buoyancy, and center of buoyancy. Normally, the center of buoyancy 
is talien to be the coordinate system origin, A new center of gravity 
and vehicle vreight are calculated based upon the loadings in the tanks. 
Then the C, G, and W are used to calciilate the gravity forces on the 
vehicle and the values of the A matrix. 

At this point in subroutine OVMOD, provision is made for the 
calculation of two sepai-ate vehicle trajectories, a noisy and a 
noiseless one. The tv.’o paths are almost identical except that in 
the noisy path, moisy variables are used and disturbances are added 
to the forces. The basic solution in both paths Involves calcula- 
tion of the shroud forces, calculation of coefficient forces and 
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Figure DZ,1 ABBREVIATED FLOWCHART FOR SUBROUTINE OVHQD 
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other effector foarces using XCCAL, and solving t!ie simvdtaneous 
equation BleS for Xo 

An abbreviated flovfchart for subroutine OVIIOD is shovm in 
figure D2ole 

D2.3 SUBROUTINE XDOAL (MB, AV, XF, P. PG, U, N. X. XD. KB, L. K) 
Subroutine XDCAL computes a selected, untransformed linear or angular 
acceleration for a general ocean vehicle, XDCAL is a general sub- 
routine for second-degree coefficients, but it uses subroutines specific 
to the DSRV. 

Ihe inputs and outputs to XDCAL are the same as those to sub- 
routine OVMOD except for PG, N, and K, XDCAL operates basically by 
PG “ Vector of parameters describing the vehicle weight (l), 
buoyancy (5)» center of gravity (2 - and center of 
buoyancy (6 - 8) 

N - Same as NE in OVMOD 

K - Index of the desired linear or angular acceleration, 

1 < K < KS 

i 

I 

summing the second-degree coefficient terms using the coefficients 
calculated by XFUH3 and then by adding on the forces and moments of 

I 

|| the desired effectors, A listing of the coefficient functions and 

r 

their selection constants is given in Appendix A2, 

D2,4 SUBROUTINES ACALC AMD SEGAL 

Subroutine ACALC is used by OVMOD to calculate the derivative 

I 

coefficient matrix. A, given by equation Dl,9* These values ja'e 
calculated selectively using the vehicle parameter vector' P and the 
' gravity and buoyancy vector PG, 
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Subroutine SECAL is used by OVMOD to calculate the cross-flow 
drag or secondary-drag forces and r.omGnts encountered when the vehicle 
moves vdth v, w, q, or r. The secondary drag equations are highly 
nonlinear equations involving coefficients (2^}-) and (^). 

These equations are presented in Appendix A3. 

Both subroutines ACALC and SECAL are specifically viritten for 
the DSRV. 

The Fortran IV statements for subroutines OVMOD, XDC/iL, XFUHS, 
SECAL, and ACALC are included in Appendix a 6. Tne next chapter 
describes the DSRV effectors and presents the input-output descriptions 
of the effector subrovitines. 



- 268 - 



CHAPT^a D3 



kffector subroutines 

The subroutines uhich are Cculled by OVJiOI) as effectors are; 

TANKS, GRAVT, SHC^iL, PRCAL, THOAL, COCAL, and XDIST. Each of those 
effectors vdll be described and its equations presented. The Fortran 
IV subroutines for the simulation of each effector are presented in 
Appendix A?, The infonaatiori presented in this chapter is not 
intended to be a complete description of each effector, but merely 
an aid in understanding and using the subroutines. For more informa- 
tion on the development of these equations and more details of the 
effectors, see (B-9) and (B-2), 

D3,l TANKS 

Tcinks equations for vehicle center of gravity 



■' S H. S 6 U, 



D3.1 



Same form for y^ and Zq except and are used 

Irfhere = equilibrium tank loadings 

a incremental tank loadings 
» Z - equilibrium vehicle freight 
V/ K E 6 « vehicle vreight 

“ location of C.G. of i'th tank 
TANKS (P, H, U, NT, PG) 

P - Para,meter vector containing the tank equilibrium 
loadings and the tanl: locations in the order 
(starting at P(m)) of x^, y^^, z^ 



M “ Location of first tank parameter in P 
U “ Input tank loadings starling at U(l), 1;^ 

NT - Number of Tanks 

PG - Gravity and Buoyancy Vector, described in D2.3 
Subroutine TANKS is valid for a general system of iJT tanks, 
D3.2 GRAVT 

Gravity forces and moments equations D3.2 

= -(W - B) sin 0 

Yq = (W - b) cos 0 sin ^ 

» (W - B) cos 0 cos 0 

Kq « (y^, W ~ y^ B) cos 0 cos 0 - 

« 

(z^ W - Zg 3) cos 0 sin 0 

Mg = -(Xg W ~ Xg B) cos 0 cos ^ - 

(Zg \I - Zg B) sin 0_ 

Mq - (Xg W “ Xjg B) cos 0 sin 0 + 

(Yg W - yg B) sin 0 

Where B « vehicle buoyancy 

0,0= vehicle angles with respect to equilibrium 
Tlisse equations simplify vrhen Xg, yg, Zg are zero. 

GRAVT (M, a, N, P, X, K, L) 

M - Center of Buoyancy = 0 indicator, M = 0 means C.B, 
A - Input Vehicle angles in radians 
N - Location of first vehicle angle in vector A 
P - Same as PG vector in D2.3 
X - Output forces and moments calculated 
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K - Number of termc to be calculated, came as KB in OVKOD 
L - Vector of indices of terms to be calculated 
D3.3 SHCAL 



The shroud is, from a simulation standpoint, the most complex 
effector on the DSRV, The shroud equations are developed in 
reference (B*“9)« The shroud angles are 6p and 6y. In the forev;ard 
mode (u > o) the angles are defined such that -i-6p produces -Z and 
-M while -j-6y produces -f-Y and ~N, The shroud is almost ineffective 
for u < 2 ft. /sec. 

Shroud Equations 



«2s' 




"cos 6y sin 6y 


0 




cos 6p 


0 


-sin 6p 


^^2s 


vs 


-sin 6y cos 6y 


0 


* 


0 


1 


0 


_W2s- 




_ 0 0 


1 




_sin 6p 


0 


cos 



1 0 0 0 0 
0 10 0 0 



0 0 1 0 Xg 0 



* {^u V w p q r] 
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ttg == tan"-^ (v|g + w|g)2 - tan"-^ v. 



u, 



2s 



^2s 



D3.^ 



LIFT - i-/’ V® Sj, (ttg) 



DRAG = i-/> Cj3 (ttg) 



= LIFT cos ttg -S- Erag sin ttg 



F„ =» LIFT sin a - Drag cos 
US s S 
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D3.6 

D3.7 

D3.8 
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1)3.9 
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■'vs - - ^ ”f 
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F 




xs 




F 




ys 




F 




zs 

_ — 1 





cos 6y'cos 6p sin 6y -cos 6ysin 6p 
-sin bycoB 6p cos by sin 6y*sin 6p 
sin 6p 0 cos 6p 



sn xs 

Yc:V> - F 
sn ys 

"sh - '^.s 

M ^ = X -> 
sh s 

^Sh “ “^s 



-1 


F 

us 


> “ V.2s^ 


F 

vs 




F 

ws 



'■ "sh 
" 'sh 



-1 
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us 
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F 

vs 




F 

vrs^ 
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D3.12 



V/here : 
u 
a 



2s' '^2s' ' velocities of shroud in shroud coordinates 

- angle between incoming flovr and shroud 
centerline 

X E! shroud location on the vehicle (-24.59 ft.) 

= fluid specific giravity (1.994) 

Sj, = surface area (14.64) 

Cj (a ) - shroud lift coefficient, calculated by 

RGCOM using a series of connected straight 
lines for different regions of Cg, there 
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are 16 parameters beginning at P(103) , 
6 ranges, 5 slopes, 5 intex'copts which 



are used by RGCOM to calculate , straight 
lines approximate curves in (B-9) 

” shroud drag coefficient, calculated same 
3-s , 31 parameters beginning at 

P(ll9), 11 ranges, 10 slopes, and 10 
Intercepts, These straight lines for 
Cj^, Cjj are approximations for the curves 
given in reference (B-9), 

V" “ «ls '^Is + «ls 

» 

SHCAL (P, M, X, U, N, NS, NL, ND, XS, KB, L) 

P - vehicle parameter vector', same as in OVKOD 

I 

M - location of first shroud parameter in P . , 

p 

X - vehicle augmented state vector 

U - vehicle input vector 

N - location of first shroud angle in U (8) 

NS - number of shroud input angles (2) 

NL - number of regions in lift coefficient C (5) 

ND - number of regions in drag coefficient Cjj (lO) 

XS - output vector of shroud forces and moments 
KB,L - structure selection inputs as in OVMOD 
The shroud equations are so structured that it is best to cal- 
culate all selected shroud forces at once rather than independently. 
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Ihe subroutines used by SHCAL are ASCOM, RGCOM, UTCOli, and SIHQ, 

Subroutine ASCOH coriputes the shroud an^le a using equation 1)3. A. 

s 

Subroutine RGCOM is used to compute the straight-line approximate 
values of the lift and drag coefficients, and Cj^. Subroutine 
UTCOH computes the product of the three matrices in equation D3. 3* 
Subroutine SIMQ is a simultaneous equation solver from reference (l-l), 
the IBH/SSP and is presented in Appendix A4, 



D3,^ PRCAL 

The propeller equations are of similar structxure for each degree 
of freedom but have different parameters depending upon the region 
of operation, 

I 

Propeller Equations, propeller inputs aire n, n 

v^ = V + X r 
P P 

H = K - X q 
P P 



X Parameters 
P 



Regions for Xp, equations 

1 u > 0, n/u > -0.21 0 1 

2 = u > 0, n/u < -0.21 3 ^ 

3 = u<0, n>0 6 7 

4 = u < 0, n < 0 9 10 11 

Parameters located at M Index 



2 

5 

8 



32 

32 

32 

32 



pQ n inl P^ un P^ u® + n (v^ + 



D3.13 



Kp « P^^ n inl + P^7 im + P^g u^ + P33 n (v^ + + P3^ h 

D3.14 
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I 

i 



ij 




Region Paxameter indexes 



1 


16 


17 


18 


2 


19 


20 


21 


3 22 


23 


24 


4 25 


26 . 


27 


Regions for Y , 







P P P p 



1 n > 0 



2 n < 


: 0 




Y , N = 
P P 


P, o n V 

12 p 




it 


P, 1 , n w 
14 p 




Parameter 


indexes 




Region 


Y N 

P P 


X 

p 


1 


12 30 


14 


2 


13 31 


15 



Where: 



33 34 

33 34 

33 34 

33 34 



D3.15 

D3.16 

I 

P 
28 

t 

29 



Xp = propellor location on vehicle, P(M + 3^), (-25.5) 
n = propellor rotation, rps 
n - propellor acceleration, 



PRCAL (P, H, X, U, N, NP, XP, K) 



P, M, X, U, N - sane as in SHCAL, except N « (lO) 

NP - number of propellor inputs (2) 

XP - output of propellor force or moment 

selected by K 

K - index of desired force or moment 
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D3.5 THCAL 

For the purposes of this thesis, the steady state (dn/dt = O) 
thruster equations axe used. 



Thruster equations (B"9) 
^th “ ^ ^th mn 
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Where: 

m = y, z - thruster directions 
n = f, a “ fore and aft thruster sets 

-> thruster force coefficients approximated as 
straight lines and calciiLated using RGCOM, 

(B-9) curves 

- thruster moment coefficients, calculated same as 
All coefficients are functions of A = u/ |nf 
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THCAL (P, H, U, N, X, XT, K) 

P, H, U, X, H - same as in SHC/iL, except li = (IP) 

XT - output thruster force or moment seloctod 

by K 

K - index of desired force or moment 

D3.6 COCAL 

COCAL (P, H, X, XC, K) Constant forces and moments selected from P 
P, H, X, K - same as previous effectors 
XC ~ selected constant force or moment 

D3.7 XDIST 

Subroutine XDIST is a general disturbance generator whicli uses 
subroutines GAUSS and RAKDU from the IBM/SSP (I~1). 

XDIST (I, P, M, X, K, N) 

I - vector of noise generation integers used by RANDU 
P,M - same as previous effectors 
X “ output selected noise force or moment 
K - selection index 

N - number of possible forces and moments (6) 

The Fortran IV statements for subroutines TANKS, GRAVT, SHCAL, 
PRCAL, THCAL, COCAL, XDIST, ASCOM, RGCOM, and UTCOH are included in 
Appendix A?. Subroutines SIMQ, GAUSS, and RANDU from reference (l~l) 
are included in Appendix A4. 

Ihese three chapters, Dl, D2, and D3, have presented the equa- 
tions and the input-output descriptions of the subroutines necessary 
to simulate the DSRV in any selected combination of six degrees of 
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freedonit Ihe next three chapters, D4, D5, and D6, present the equa- 
tions and the subroutine descriptions necessary to calculate the 
gradient of the D3RV forces and moments selectively with respect to 
the vehicle states, coefficients, and parameters, Ihese gradient 
subroutines are used in Kalman Filtering. 



- 278 - 



CHAPTER 1)4 



general ocean vehicle and dsrv gradient formui, axioms 

Ihe state space gradient for an ocean vehicle is essential to 
almost all identification techniques. It is required for propogation 
of the error covariance matrix in a Kalman Filter and is required 
for best estimate calculations in many techniques which linearize 
the state equations about a certain trajectory. Given a general 
state space system as in equation D4,l, the desired gradient is given 
by equation D4,2. 



X = f (Xf u) D4.1 

(s» li) 

Ihe gradient can novj be expressed in terms of a general ocean 
vehicle equation Dl.l repeated here as D4. 3» The gradient of 1)4,3 
is given by D4c4 for the case in which A is a constant matrix. For 
the case in which A(£) is dependent upon vehicle parameters, equation 
I4,5 must be used, and calculation of the A derivative term does 
appear to be straightforevrard, as seen in equation Di),6, 



A(£) X = f (x, £) + (x, u, £) -!■ G u 
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D4,3 



D4.4 



D4,5 
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D4,6 



The (pradient subroutine in this thesis uses equation and docs 

not permit identification of those paxameters in the A-matrlx (added 
mass and moment of inertia terms) vrith Kalman filtering. 

The calculation of the gradient matrix for a general ocean 
vehicle nov? proceeds by applying equation D4,4 to equation D2.1 and 
then developing the equations and programming for the calculation of 
the coefficient and effector derivatives. The details of the equations 
and programming for the gradient routines are presented in chapters 
D5 and D6, 
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CHAPTER D5 



OCEAN VEHICLE DERIVATIVE SUBROUTINE (OVDIDR) 

This chapter presents a programming description of the sub- 
routines for structure-selectively calculating the gradient matrix F 
in equation Dt'-,2 using equations. D4.4 and. D2.1,. .The gradient sub- 
routine (OVDSR) is designed to be a companion to the general ocean 
vehicle subroutine (0VM0D)« Many of the inputs and calculation 
techniques in both are the same, except that OVDER has a much greater 
computation task to perform than OVMOD, The Fortran IV statements 
for OVDER and its subroutines are presented in Appendix A8. 

D5.1 INPUTS AND OUTPUTS OF SUBROUTINE OVDSR 

As in OVMOD, all of the inputs and outputs are in vector or 
constant form to permit variable dimensioning. Numbers listed here 
are those used in the DSRV studies, 

OVDER (he, U, AV, XF, KP, LF, KB, L, X, KP, LP, P, F, NF, NE) 
Inputs ; 

ME, AV, XF, P, U, NE, X, KB, L - Same as OVMOD, Chapter D2 

KF - Integer 0 < KF < 126 describing the number of second- 
degree coefficients to be used in the gradient matrix 
calculation 

LF - Vector describing the indices of the second-degree 
coefficients used in the gradient 

KP - Integer 0 < KP < 126 describing the number of 

parameters of vector P to be used in the gradient 
matrix calculation 

LP - Vector describing the indices of the parameters used 
in the gradient 
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Outputs ; 



F ~ Output gradient matrix of dimension KB * NF 

(kb = number of selected vehicle primary states, 
maximum of 6 for D3RV, u, v, vr, p, q, r) of the 
form of equation D5.1 
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NF - Output constant KB < NP < 200, NF = KB + KF + KP, 
describing the number of columns in F , 

D5.2 PROGRAMMING DESCRIPTION OF SUBROUTINE OVDER 

Ihe calculations necessary to the computation of the gradient 

I 

matrix F in equation D5.1 naturadly divide themselves into three 
groups! calculation of partials with respect to primary states, 
with respect to second-degree coefficients, and vrith respect to 
parameters. As in OVMOD, all of the programming in OVDER must be 
structure selective, Hoviever, the structure selectivity in OVDER 
must apply not only to the states but also to the second-degree 
coefficients and to the parameters, 

Ihe programming necessary to compute the gradient matrix F 
involves utilizing subroutines XDDER, XFDER, and XPDER to calculate 
the three groups of partial derivatives in F, Subroutine OVDER 
Begins, as in OVMOD, by calculating the vehicle center of gravity, 
weight, buoyancy, and center of buoyancy. These values are used to 
compute the A-matrix which is then inverted selectively depending 
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upon its dimension. 

Next, a serj.es of steps sets up the structure and paraiacters 
for calculating the KB * KB derivatives vrith respect to the primary 
states by subroutines XDDER, SEDER, PRUER, THDSR, and SHDSR, Ihese 
resultant derivatives are then compressed into the vector’ F, 

Ihe following KB * KF derivates with respect to the second- 
degree coefficients are calculated by XFDER and compressed into F, 
and the KB * KP derivates with respect to the parameters are calcu- 
lated by XPDER and compressed into F, The final step in OVDER is 
then the derivative transformation which consists of multiplying F 
by A“^, 

9 

Subroutine OVDER uses the three general -utility subroutines <• 

A 3 INV, HINV, and GMPRD, Subroutine A3INV is a self-explanatory 
routine for inverting a general 3*3 matrix. Subroutine MINV is an 
N * N matrix inverter from the IBH/SSP (l-l), and GMPRD is a matrix 
multiplier from the IBM/SSP, Ihese IBM/sSP routines are presented, 
for the convenience of the reader, in Appendix A4, 

The following subroutines used by OVDER are also used by OVMOD 
and are described in Chapters D2 or D3s TANKS, ACALC, XFUNS, SECAL, 
RGCOM, and UTCOM, The next portions of this chapter describe sub- 
routines XDDER, XPDER, and XPDER - the three main subroutines of OVDER. 
D 5.3 SUBROUTINES XDDER AND SEDER 

Subroutine XDDER calculates the partial derivatives with respect 
to the primary states of the terms under the double summation in 
equation D2,l and furnishes them for inclusion into the first KB * KB 
terms of F in equation D5«l. 
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XDDER (AV^ XF, P, PC, X, DX, K, H, KB, L) 

A.V I XF , P, X, KB, L “ ScUiie as OVI’iOD, ChapLsr D2 
PC - Sane as PG in XDCAL Chapter D2«3 
DX - Output vector of partial derivatives vfith respect 
to states 

K - Index of the teim to be differentiated, 1 < K < KS 
M - Index of the state uith respect to v;hich the partial 
derivative is taken, 1 < M < KS 

Subroutine SEDER calculates the partial derivatives of the X^„^ 
tern in equation D2,l with respect to the primary states. This is 
done by branching to the proper partial derivative function based 
upon input index K, These functions represent all of the statevj'ise 
partial derivatives of the secondary drag functions in Appendix A3. 

SEDER (P, H, X, DXS, K) 

I 

P,X ~ Input paraaiieter and state vectors . • 

H “ Location of first secondary drag parameter in P, input 
DXS - Output of selected derivative of the K-th term 
K “ Input index of desired secondary drag derivative 

Ihe other subroutines used for calculating derivatives with 
respect to the primary states are the effector routines s PRDER, 

THDSR, and SHDER, These subroutines are d.escribed in Chapter Do on 
effector gradient subroutines, 

D5.4 SUBROUTINE XFDSR 

Subroutine XFDER calculates the partial derivatives vilth respect 
to the second-degree coefficients of the terms under' the double 
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summation in equation D2.1, These KB "'■ KK terms are then compressed 
by OVDSP. into the gradient vector F, Trie XFBEIi parUal derivatives 
are calculated using a lengthy selection procedure and using sub- 
routine XDFNS vrhich gives the derivatives of the second-degree co- 
efficient fxinctions ifith respect to the second-degree coefficients. 
Subroutine SECAL is used for calculating partial derivatives with 
respect to those tvro second-degree coefficients used in the secondary 
drag calculations. 

XFDER (AV, XF, P, PC, X, XFD, KF, LF, KB, L, KS) 

AV, XF, P, X, KB, L - Same as OVMOD, Chapter D2 
PC - Same as PG in XDCAL, Chapter D2.3 
KF, LF - Same as OVDER, Chapter D5.1 

MS - Location of first secondary drag parameter in P 
XFD - Output vector of partial deriva-tives with respect 
' to the second-degree coefficients ' . 

XDFNS (P, X, K, I, D, N) 

P, X - Same as OVMOD, Chapter D2 
K - State vector index of desired second-degree 
coefficient 

I - Same as XF vector in OVMOD, Chapter D2 

D - Output derivative of second-degree coefficient 

function viith respect to the selected second- 
degree coefficient 

N - Output zero indicator, N = 0 when D = 0. , and 
N » 1, when D 0, 
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P5,5 subroutines xpder ahd se-dep 

Subroutine XPDER oal.cu3,ates t}ie partial derlvalivcu vrith re- 
spect to the parameters of the terms in equation D2.1. Ihese KB * KP 
terms are then compressed by OVDER into the gradient vector F, 
Provisions have not been made to calculate derivatives with 
respect to all of the parameters in vector P, Derivatives are not 
calculated >fith respect to the parameters in the A“Hia.trix. This 
would require implementation of equations D4.5 aod Dij-,6 and has not 
been done in this thesis. Derivatives are not calcxilated Vfith 
respect to the parajaeters in the second-degree coefficient functions, 
the tanks parameters, the shroud parameters, the noise parameters, 

9 

the variable parameters, the mass of the vehicle, or the acceleration 
of gravity (Appendix Al), 

Derivatives are calculated with respect to the secondary drag 
parameters' (SEDSP) , the propeller parameters (PRDEP), the thruster 
parameters (tuDEP), and the constant terms parameters. Subroutines 
PRDEP and THDEP are described in Chapter D6, 

XPDER (P, he, U, NE, X, XPD, KP, LP, KB, L, NT) 

P, ME, U, NE, X, KB, L - Same as OVHOD, Chapter D2 
XPD - Output vector of partial derivatives v/ith respect 
to the vehicle parameters 
KP, LP - Same as OVDER, Chapter D5»l 
NT •• Input vector describing thruster derivative 
numbers of regions in P 
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Subroutine SEDEP is used by XPDEO to calculate the partial 
derivatives of the untransforined vehicle forces and moments with 
respect to the secondary drag pax’ameters. These derivatives are 
calculated by branching to the proper partial derivative function 
based upon input index K, Ihese functions represent all of the 
parameterwise partial derivatives of the secondary drag functions 
in Appendix A3. 

SEDEP (P, M, X, XS, K, J) 

P, X - Input parameter and state vectors 

M - Location of first secondary drag parameter in P, input 

XS - Output of selected derivative of the K-th term with 

respect to the J-th pairameter 

K - Input index of the K-th vehicle force or moment term 

J - Input index of the J-th secondary drag parameter 

This chapter has presented a basic description of subroutine 
OVDER and its associated primary subroutines XDDER, XFDER, and XPDER, 
Ihe Fortran IV statements for OVDER and its associated subroutines 
described in this chapter are presented in Appendix A8, The next 
chapter presents a basic description of the effector gradient sub- 
routines which are used by OVDER in calculating the gradient matrix F. 
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CHAPTiifl D6 



effector gradient subroutines 

TOe subroutines vfhich are called by OVDER as effector gradient 
subroutines are SHDER, PRDEH, lilDER, PRDEP^ and THDEP, A basic 
description of each of these subroutines vdll be presented in this 
chapter as an aid in understanding and using these subroutines. The 
Fortran IV statements for these subroutines are presented in 
Appendix A9, 
d6.i subroutine SHDBR 

Subx'outine SHDER is mathematically the most complex vehicle 
subroutine in this thesis. Tlie complexity arises from the two 
transformations and the nature of the shroud angular functions. 

SHDER computes the partial derivatives of the sfiroud forces and 
moments with respect to the primary vehicle states. These partial 
derivatives represent, quite literally, the partial derivatives of 
equations D3«3 through D3.12. A complete description of SHDER is 
not presented here, but enough of the partial derivative equations 
are presented to facilitate \mderstanding and utilisation of the 
subroutine vrhen compared vrith SHCAL in Chapter J)3*3c 
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Equations D6,1 tlirough D6,12 in conjunction with equations D3.3 

through D3.12 represent the essence of the shroud and shroud derivative 

calculations. Subroutine ASDSR is a grouping and calculation of several 

of the a.g equations for convenience. Subroutine UTCOM coraputes the 

product of the three matrices in equation D3» 3* Subroutine PiGCOh 

is used by SHDBIR to compute the lift and drag coefficients Jilong uith 

their derivatives with respect to a . Subroutine A3INV is a general 

s 

3*3 matrix inverter, and subroutine GMPRD is a general matrix 
multiplier from the IBM/SSP, 

SHDER (P, H, X, U, N, KS, NL, HU, NDL, HDD, XSD, KB, L) 

P, X, U, KB, L - Same as OVMOD, Chapter D2 
M ^ Location of the first slu*oiid parameter in P 
N - Location of the first shroud angle in U 
NS - Number of shroud angles 

NL ~ Number of lift coefficient straight line regions 
ND - Number of drag coefficient straight line regions 
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NDL - Number of lift coefficient derivative straieht line 
region r. 

NDD •> Number of drag coefficient derivative straight line 
regions 

XSD - Output shroud derivative vector, equation D6,1 
d6,2 subroutine PRDER 

Subroutine PRDER computes the derivatives v?ith respect to the 
primary states of the propeller forces and moments. These derivatives 
are calculated by branching to the proper functional partial deriva- 
tives of equations D3.13 through D3.l6, 

PRDER (P, M, X, U, N, NP, XP, K) 

P, M, X, U, N - Same as in SHOAL, Chapter D3, except N (lO) 
NP - Nvtmber of propeller inputs (2) 

XP - Output partial derivative 

K - Indexes of desired partial derivatives, 1 < K < 3o» 

(i, j) « K « i + 6(j - 1) 

D6.3 SUBROUTINE THDSR 

Subroutine THDSR computes the derivatives of the thruster forces 
and moments with respect to the primary states of the vehicle, Tbese 
derivatives are calculated by branching to the proper partial deriva- 
tives of equations D3»l? and D3tl8 and then by using subroutine RGC0^5 
to compute the thruster coefficient derivatives as straight line 
approximations of the curves in reference (B-9)« 

THDSR (P, M, U, N, X, XT, K) 

P, M, U, X - SaiQe as SHOAL, Chapter D3 
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N - Same as NT in X?DSR> Chapter 

XT - Output, partinl derivative ^xl', /^x 

th'^^ j 

K “ Same as PRDER, Chapter D6,2 
d6,4 s ubroutine PRDHIP 

Subroutine PRDEP computes the derivatives of the propeller forces 
and moments with respect to the selected propeller parameters. 'Ihese 
derivatives are calculated by branching to the proper functional par- 
tial derivatives of equations D3.13 through D3.I6. 

PRDEP (P, M, X, U, N, NP, XP, K» J) 

P, H, X, U, N - Same as in SHCAL, Chapter D3, except N = (lO) 

NP - Number of propeller inputs (2) 

XP ** Output partia.1 derivative ^ 

K - Index of force or moment 
J - Index of parameter 
d6.5 subroutine TKDEP 

Subroutine THDEP computes the derivatives of the thruster forces 
and moments with respect to the selected thruster parameters. These 
derivatives are calculated by branching to the proper partial deriva- 
tives of equations D3»17 and D3.I8 or else by using subroutine RPDSR 
to calculate the parametric deriva,tives of the straight line approxi- 
mations of the thruster coefficients. 

TKDEP (P, H, U, N, X, XT, K, J) 

P, M, U, K, X - Same as THDER, Chapter D6,3 
XT - Output partial derivative ()X^jy3Pj 
K,J - Same as PRDEP, Chapter d6,4 

This chapter has presented a basic description of the DSRV 
effector gradient subroutines. The Fortran IV statements for the 
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effector gradient subroutines described in this chapter are presented 
in Appendix A9» The next chapter describes methods for modifying 
all of the D3RV subroutines for use vflth other ocean vehicles and 
suggests several programming simplifications which could be applied 
to the DSRV model subroutines. 
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CHAPTai jD7 



PROGRAM SIMPLIFICATIONS AND KODIFICATIONS 

The purposes of this chapter are to describe the modifications 
necessary to OVKOD and OVDER for calc'olation of vehicles other than 
DSRV and to recognize that these subroutines have several possible 
program simplifications , 

D? . 1 PROGRAM SIMPLIFICATIONS 

Subroutines OVMOD and OVDSR along vdth their associated subroutines 
were vnritten and debugged separately, directly, and suboptimally. As 
written, however, they do their jobs, and so the author has not 
devoted any extra time to "cleaning up the code," reducing the nimber 
of cards, or speeding them up. 

The most obvious and potentially profitable work to be done is 
the combination of OVMOD a.nd OVDER into a single subroutine. Several 
of the functions computed by each arc identical, and many of the 
variables computed by one can be used by the other. Some provision 
should be made in the combined subroutine to allow deferring calcu- 
lation of the gradient v?hen the model is to be used in a model reference 
framework. 

Another set of possible simplifications arises from the fact 
that all of the equations vrere written out comjjletely in several 
cases and not combined by type. An example of this is in ACALC, 
where AC => 0, api>ears many times and could be written only once vfith 
proper changes in the initial conditional GO TO statement numbers. 

Several other subroutines to which this simplification would apply 
ares XFUNS, COCAL, XDPNS, XPDSR, and PRDER, 
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In several subroutines j there exc sections containing the sane 
or nearly tho sarr.e sequence of steps. Ihese could perhaps be simpli- 
fied by making those sections into subroutines. For example, in 
subroutine TPICAL there are several groups of about 20 statements 
each \;hich have soraevfhat the same structure and could be revrritten 
into a subroutine. The noisy and noiseless sections of OVhOD could 
also be combined into a single subroutine. 

It is now evident to the author that there are several sub- 
routines vrhich contain unnecessary conditional GO 10 statements and 
ISW indicators. An example of this is in subroutine SEGAL, v;here 
the first conditional GO TO (2,3) ISW is unnecessary if in the two 
preceeding statements the ISV/ = *s were changed to GO TO 's. In 
fact, one of the two preceeding statements could also be dropped. 

This type of simplification is evident elsewhere in SEGAL as well 
as in several other subroutines, 

D?,2 PROGRAM M OD IFICATIONS FOR OTHER OCEAN VEHIGLES 

The keynotes of OVMOD and OVDER as raitten are structiure selectiv- 
ity, second-degree coefficients, and DSRV effectors. Any potential 
user of these subroutines who does not require structure selectivity 
for reducing the parameter space would be vfell advised to wite his 
own OVKOD/OVCER rather than trying to modify this one. The entire 
fabric of these tvro subroutines is vioven from structure selectivity 
statements and a considerable percentage of the computation time 
(est, 20-30^) is spent selecting structure. 

Any potential user who requires linear, third-degree, fovu'th- 
degree, etc, , coefficients or vrho does not require second-degree 

coefficients would have to rewrite XDCAL, XDDER, and XFDlilR based upon 
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thQ requixeiueiits of nis inodei. It is anticipated that the prograin- 
Ring necessary to include additional coefficients villl be straight- 
forevrard extension of tiie techniques used for the second-degree 
coefficients. 

The DSRV effector subroutines vrill not be applicable to most 
other ocean vehicles. The TAliKS, GRAVT, and COCAL could probably 
be used directly for any ocean vehicle, but the SHCAL, SECAL, PRCAL, 
and THCAL (shroud, secondary drag, propeller, thrusters) subroutines 
are specific to the DSRV, Anyone vrishing to use OVMOD/OVDSR should 
trite effector subroutines specific to his vehicle and include param- 
eters and calling statements in OVIIOD and OVDER, 

D7.3 SECTION 5(D) SUMMARY 

This section has presented the detailed equations for calcula- 
tion of the time derivatives and their gradients of the linear and 
angular velocities of a general ocean vehicle. A subroutine for 
calculating the linear and angular accelerations (oVMOD) has been 
presented and its vise explained. A subroutine for calculating the 
gradient v.’ith respect to states and parameters of the linear and 
angular accelerations (OVDER) has also been presented and its use 
explained. Effector subroutines specific to the DSRV have been 
included for both OVMOD and OVDER and explained. The Fortran IV 
statements for these chapters are found in Appendices A6 - A9. 

The next section 6(C) presents the programming and analysis 
for utilization of these model and gradient subroutines in the iden- 
tification and id.entifiability studies of the DSRV coefficients and 
parameters. 
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SECTION 6 



IDENTIFICATION STUDIES OF THE DSRV DYNAMIC COEFFICIENTS ( C^ 

Cl MAIN 6*6 IDENTIFICATION PROGRAM DESCRIPTION AND SEA 
TRIALS (main) 

C2 MODEL RSFICRENCE CONTOURS FOR SELECTED DSRV 6*6 PARAMETERS 

C3 DESCRIPTION OF SEVERAL SUBROUTINES I'OR USE IN THE MAIN 
PROGRAM 



"THE PURPOSE OF COMPUTING IS INSIGHT, NOT NUMBERS." - 

R. W. HAMMING (H-5) 



THIS SECTION PRESENTS A DESCRIPTION OF AND SOME RESULTS FROM A 
STRUCTURE-SELECTIVE SIX DEGREE OF FREEDOM IDENTIFICATION PROGRAM 
WHICH USES THE DSRV MODEL OF SECTION 5(D) . THE COMPUTER RUNS ARE 
DESIGNED TO SHOW HOW THE PRIMARY VEHICLE BEHAVIOR CHANGES AS MORE 
degrees of freedom are INCLUDED AND TO SHOW THE MODEL REFERENCE 
CONTOURS OF SEVERAL SELECTED DSRV COEFFICIENTS AND PARAMETERS IN 
MULTIPLE DEGREE OF FREEDOM MODELS. 
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CHAFr-ER Cl 



MftIN 6*6 IDENTIFICATION PROGRAM DFl’SCRIPTION AMD SEA TRIALS (MAIH) 

The extensive studies of Section 4(P) have shovm that the model 
reference contoviring and extended Kalman filtering technqiues are 
valid for the DSRV single degree of freedom equations. This section 
shows that the model reference contouring technique is valid for the 
DSRV in one through six degrees of freedom for several selected coeffi- 
cients. The DSRV mathematical model has been presented and its sub- 
routines described in Section 5(P)j this model is used in the main six 
degree of freedom, structure-selective identification program developed 
for the studies of this section, ’ 

This chapter presents a description of the DSRV sea trial behavior 
in 1 through 6 degrees of freedom using a simulated ramp input to the 

I 

DSRV propeller. A description of the MAIN program for generating this 

f 

data and for identifying selected vehicle parameters from it using 
model reference contouring is also presented. The next chapter shows 
the identification results from using the model reference contouring 
technique on multiple degree of fi'eedom sea tr'ials and mathematical 
models, 

Cl.l DSRV SEA TRIALS IN 1 THROUGH 6 DEGREES OF FREED OM 

The flexibility of the main program to be described in Chapters 
Cl, 2 and 01.3 allows the running of DSRV sea trials using models vrith 
2, 3» 5» or 6 degrees of freedom using the same input function. 

This offei's a useful set of results in that the vehicle coupling and 
decoupling may be observed. For example, if the surge velocity is the 
same for a 1 degree of freedom (DOF) model as it is for a 6 DOF model. 
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then the identlfiability cheLracteristics of the directly related 
parameters in sxirge for 1 DOF should be applicable to the same param- 
eters in 6 DOF for the same maneuver. 

The input function to be used in these runs is a simulated ramp 
function to the DSRV propeller. This input function is plotted as 
curve #1 in Figure Cl.l» and the propeller angular acceleration is 
shown by curve §2 in Figure Cl,l, This input will remain the same 
for all of the sea trials described in this chapter. 

Using the input in Figure Cl,l and the MAIN program (prii.iarily 

N 

subroutine SSATR) of Appendices A19 and Al?, the DSRV sea trials for 

46 seconds, without any control systems or tanks inputs, were calcu- 

« 

lated using 1, 2, 3» 5« s-ad 6 degree of freedom models. For each 

of these models the respective DSRV velocities and angles were plotted; 
these sea trials will be described here in ascending degree of freedom 
(DOF) order, 

1 DOF SURGE (u) 

The response of the DSRV mathematical model to the simulated 
ramp input when the vehicle velocities v, w, p, q, and r are not 
included is shown in Figure Cl, 2, As can be seen from this figure, 
the DSRV accelerates from 0,2 ft/sec to 1,3 ft/sec diu'ing the 46 
second sea trial. Figure Cl, 2 also represents the DSRV surge behavioi' 
for all of the multiple degree of freedom models to be described in 
this chapter. The shapes of all of the surge ciurves are almost identi- 
cal, and therefore, only the 1 DOF - Figiure Cl, 2 and the 6 DOF - 
Figure Cl, 13 surge velocity curves are Included in this chapter. 
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2 DOF SURGE. ROLL ( u, p) 



Ihe roli. response of the DSRV v/hen a 2 nodel is used and 
when the roll angular velocity is integrated at each time step to give 
the roll angle used in the gravity forces calciO.ations is shown in 
Figure Cl»3. The actual DSRV roll angle (radians) throughout the 
sea trial is shown in Figure Cl, 4, The surge velocity in 2 DOF is 
elrnost identical to Flgiure Cl, 2. 

Figures Cl, 3 and Cl, 4 show that for this input the DSRV is almost 
unstable in its roll response to this sea trial input} the vehicle 
has a roll rate period of about 10 seconds, a maximun roll rate of 0.5 
rad/sec, and reaches a maximum roll of 0,79 radians. The fact that 
the sinusoida.1 roll velocity amplitude in Figure Cl, 3 is increasing 
at a decreasing exponential rate means that even for the simulated 
ramp input of Figure Cl,l the roll rate v.'ould eventually become 
either a constant-aip.pl itude or a decreasing-amplitude sinusoidal func- 
tion for a longer sea trial.. Of course in the real DSRV the mercury 
list tanks and their associated control systems keep this kind of 
oscillation in roll to a minimum; but for the identification studies 
of this thesis, this kind of behavior is completely acceptable and, 
in fact, desirable, 

A.nother important fact which is indicated by the behavior of 
the surge and roll for this input is that the DSRV roll is not coupled 
into surge. Ihis means that for the 2 DOF model, the surge and roll 
parameters may be identified separately. 

3 DOF SURGE, HSAVE, PITCH (u, vr, q) 

Tne vertical plane behavior of the DSRV for a simulated ramp 
input is shown by Figures Cl, 2, Cl, 5, and Cl, 6 for the vehicle surge 
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0.230E 02* proceeds  "by  applying  equation  Dty.'l-  to  equation  D2.1  and 
then  developing  the  equations  and  programming  for  the  calculation  of 
the  coefficient  and  effector  derivatives.  The  details  of  the  equations 
and  programming  for  the  gradient  routines  are  presented  in  chapters 
D5  and  1)6, 
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CHAPTER  1)5 

OCEAN  VEHICLE  DERIVATIVE  SUBROUTINE  ( OVDER) 

This  chapter  presents  a  programming  description  of  the  sub- 
routines for  structure-selectively  calculating  the  gradient  matrix  F 
in  equation  D^',2  using  equations.  D^.^-  and  D2.1,.  The  gradient  sub- 
routine (OVDER)  is  designed  to  be  a  companion  to  the  general  ocean 
vehicle  subroutine  (OVMOD).  Many  of  the  inputs  and  calculation 
techniques  in  both  are  the  same,  except  that  OVDER  has  a  much  greater 
computation  task  to  perform  than  0VM0De   The  Fortran  IV  statements 
for  OVDER  and  its  subroutines  are  presented  in  Appendix  A8. 
D5*1  INPUTS  AND  OUTPUTS  OF  SUBROUTINE,  OVDER 

As  in  OVMOD,  all  of  the  inputs  and  outputs  are  in  vector  or 
constant  form  to  permit  variable  dimensioning.  Numbers  listed  here 
are  those  used  in  the  DSRV  studies, 

OVDER  (ME,  U,  AV,  XF,  KF,  LF,  KB,  L,  X,  KP,  LP,  P,  F,  NF,  NE) 
Inputs ; 

ME,  AV,  XF,  P,  U,  NE,  X,  KB,  L  -  Same  as  OVMOD,  Chapter  D2 
KF  -  Integer  0  <  KF  <  126  describing  the  number  of  second- 
degree  coefficients  to  be  used  in  the  gradient  matrix 
calculation 
LF  -  Vector  describing  the  indices  of  the  second-degree 

coefficients  used  in  the  gradient 
KP  -  Integer  0  <  KP  <  126  describing  the  number  of 

parameters  of  vector  P  to  be  used  in  the  gradient 
matrix  calculation 
LP  -  Vector  describing  the  indices  of  the  parameters  used 

in  the  gradient 
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Outputs: 

F  -  Output  gradient  matrix  of  dimension  KB  *  NF 

(KB  a  number  of  selected  vehicle  primary  states, 
maximum  of  6  for  DSRV,  u,  v,  w,  p,  q,  r)  of  the 
form  of  equation  D5.1 


I      I 


hi.  ...  Mil  ...  il     dA  ...  il 

iu    ^Xuu   ^Nrr^l    ^n 


D5.1 


NF  -  Output  constant  KB  <  NF  <  200,  NF  =  KB  +  KF  +  KP, 
describing  the  number  of  columns  in  F  , 

D5 . 2  PROGRAMMING  DESCRIPTION. OF  SUBROUTINE  OVDER 

The  calculations  necessary  to  the  computation  of  the  gradient 
matrix  F  in  equation  D5.1  naturally  divide  themselves  into  three 
groups:  calculation  of  partials  with  respect  to  primary  states, 
with  respect  to  second-degree  coefficients,  and  with  respect  to 
parameters.  As  in  0VM0D,  all  of  the  programming  in  OVDER  must  be 
structure  selective.   However,  the  structure  selectivity  in  OVDER 
must  apply  not  only  to  the  states  but  also  to  the  second-degree 
coefficients  and  to  the  parameters. 

The  programming  necessary  to  compute  the  gradient  matrix  F 
involves  utilizing  subroutines  XDDER,  XFDER,  and  XPDER  to  calculate 
the  three  groups  of  partial  derivatives  in  F.  Subroutine  OVDER 
begins,  as  in  0VM0D,  by  calculating  the  vehicle  center  of  gravity, 
weight,  buoyancy,  and  center  of  buoyancy.  These  values  are  used  to 
compute  the  A-matrix  which  is  then  Inverted  selectively  depending 
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upon  its  dimension. 

Next,  a  series  of  steps  sets  up  the  structure  and  parameters 
for  calculating  the  KB  *  KB  derivatives  with  respect  to  the  primary 
states  by  subroutines  XDDER,  SEDER,  PRDER,  THDER,  and  SHDSR.   These 
resultant  derivatives  are  then  compressed  into  the  vector  F. 

The  following  KB  *  KF  derivates  with  respect  to  the  second- 
degree  coefficients  are  calculated  by  XFDER  and  compressed  into  F, 
and  the  KB  *  KP  derivates  with  respect  to  the  parameters  are  calcu- 
lated by  XPDER  and  compressed  into  F.   The  final  step  in  OVDER  is 
then  the  derivative  transformation  which  consists  of  multiplying  F 
by  A"1. 

Subroutine  OVDER  uses  the  three  general -utility  subroutines} 
A3INV,  MINV,  and  GMPRD.  Subroutine  A3INV  is  a  self-explanatory 
routine  for  inverting  a  general  3  *  3  matrix.  Subroutine  MINV  is  an 
N  *  N  matrix  inverter  from  the  IBM/SSP  (l~l) ,  and  GMPRD  is  a  matrix 
multiplier  from  the  IBM/SSP.   These  IBM/SSP  routines  are  presented, 
for  the  convenience  of  the  reader,  in  Appendix  A^-, 

The  following  subroutines  used  by  OVDER  are  also  used  by  OVMOD 
and  are  described  in  Chapters  D2  or  D3s  TANKS,  ACALC,  XFUNS,  SECAL, 
RGCOM,  and  UTCOM.  The  next  portions  of  this  chapter  describe  sub- 
routines XDDER,  XFDER,  and  XPDER  -  the  three  main  subroutines  of  OVDER. 
D5.3  SUBROUTINES  XDDER  AND  SEDER 

Subroutine  XDDER  calculates  the  partial  derivatives  with  respect 
to  the  primary  states  of  the  terms  under  the  double  summation  in 
equation  D2.1  and  furnishes  them  for  inclusion  into  the  first  KB  *  KB 
terms  of  F  in  equation  1)5,1. 
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XDDER  (AVt  XP,  P,  PC,  X,  DX,  K,  M,  KB,  L) 

AV,  XF,  P,  X,  KB,  L  -  Same  as  OVMOD,  Chapter  D2 

PC  -  Sane  as  PG  in  XDCAL  Chapter  D2,3 

DX  -  Output  vector  of  partial  derivatives  with  respect 

to  states 
K  -  Index  of  the  term  to  be  differentiated,  1  <  K  <  KS 
M  -  Index  of  the  state  with  respect  to  which  the  partial 

derivative  is  taken,  1  <  M  <  KS 

Subroutine  SEBSR  calculates  the  partial  derivatives  of  the  X 

—sec 

term  in  equation  D2.1  with  respect  to  the  primary  states.  This  is 
done  by  branching  to  the  proper  partial  derivative  function  based 
upon  input  index  K,   These  functions  represent  all  of  the  statewise 
partial  derivatives  of  the  secondary  drag  functions  in  Appendix  A3. 
SEDER  (P,  M,  X,  DXS,  K) 

P,X  -  Input  parameter  and  state  vectors     .  ■ 
M   -  Location  of  first  secondary  drag  parameter  in  P,  input 
DXS  -  Output  of  selected  derivative  of  the  K-th  term 
K   -  Input  index  of  desired  secondary  drag  derivative 
The  other  subroutines  used  for  calculating  derivatives  with 
respect  to  the  primary  states  are  the  effector  routines:  PRDER, 
THDER,  and  SHDERo  These  subroutines  are  described  in  Chapter  Do  on 
effector  gradient  subroutines, 
D5.4-  SUBROUTINE  XFDSR 

Subroutine  XFDER  calculates  the  partial  derivatives  with  respect 
to  the  second-degree  coefficients  of  the  terms  under  the  double 
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summation  in  equation  D2.1e  These  KB  *  KF  terms  are  then  compressed 
by  oVDSR  into  the  gradient  vector  F«  The   XFDER  partial  derivatives 
are  calculated  using  a  lengthy  selection  procedure  and  using  sub- 
routine XDFNS  which  gives  the  derivatives  of  the  second-degree  co- 
efficient functions  with  respect  to  the  second-degree  coefficients. 
Subroutine  SECAL  is  used  for  calculating  partial  derivatives  with 
respect  to  those  two  second-degree  coefficients  used  in  the  secondary 
drag  calculations. 

XFDER  (AV,  XF,  P,  PC,  X,  XFD,  KF,  LF,  KB,  L,  MS) 

AV,  XF,  P,  X,  KB,  L  -  Same  as  OVMOD,  Chapter  D2 
PC     -  Same  as  PG  in  XDCAL,  Chapter  D2.3 
KF,  LF  -  Same  as  OVDER,  Chapter  D5.1 

MS     -  Location  of  first  secondary  drag  parameter  in  P 
XFD    -  Output  vector  of  partial  derivatives  with  respect 
to  the  second-degree  coefficients 
XDFNS  (P,  X,  K,  I,  D,  N) 

P,  X  -  Same  as  OVMOD,  Chapter  D2 

K    -  State  vector  index  of  desired  second-degree 

coefficient 
I    -  Same  as  XF  vector  in  OVMOD,  Chapter  D2 
D    =  Output  derivative  of  second-degree  coefficient 
function  with  respect  to  the  selected  second- 
degree  coefficient 
N    -  Output  zero  indicator,  N  =  0  when  D  =--  0. ,  and 
N  ■  1,  when  D  ^  0. 
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V$,b     SUBROUTINES  XPDER  AND  SEDEP 

Subroutine  XPDER  calculates  the  partial  derivatives  with  re- 
spect to  the  parameters  of  the  terms  in  equation  D2.1.   These  KB  *  KP 
terms  are  then  compressed  by  OVDER  into  the  gradient  vector  F. 

Provisions  have  not  been  made  to  calculate  derivatives  with 
respect  to  all  of  the  parameters  in  vector  P.  Derivatives  are  not 
calculated  with  respect  to  the  parameters  in  the  A-matrix.  This 
would  require  implementation  of  equations  D^.5  and  D^-,6  and  has  not 
been  done  in  this  thesis.  Derivatives  are  not  calculated  with 
respect  to  the  parameters  in  the  second-degree  coefficient  functions, 
the  tanks  parameters,  the  shroud  parameters,  the  noise  parameters, 
the  variable  parameters,  the  mass  of  the  vehicle,  or  the  acceleration 
of  gravity  (Appendix  Al). 

Derivatives  are  calculated  with  respect  to  the  secondary  drag 
parameters' (SEDEP),  the  propellor  parameters  (PRDEP),  the  thruster 
parameters  ( THDEP ),  and  the  constant  terms  parameters.  Subroutines 
PRDEP  and  THDEP  are  described  in  Chapter  D6. 

XPDER  (P,  ME,  U,  NE,  X,  XPD,  KP,  LP,  KB,  L,  NT) 

P,  ME,  U,  NE,  X,  KB,  L  -  Same  as  OVMOD,  Chapter  D2 

XPD    -  Output  vector  of  partial  derivatives  with  respect 

to  the  vehicle  parameters 
KP,  LP  -  Same  as  OVDER,  Chapter  D^.l 
NT    -  Input  vector  describing  thruster  derivative 
numbers  of  regions  in  P 
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Subroutine  SEDEP  is  used  by  XPDER  to  calculate  the  partial 
derivatives  of  the  untransformed  vehicle  forces  and  moments  with 
respect  to  the  secondary  drag  parameters.   These  derivatives  are 
calculated  by  branching  to  the  proper  partial  derivative  function 
based  upon  input  index  K.   These  functions  represent  all  of  the 
paraneterwise  partial  derivatives  of  the  secondary  drag  functions 
in  Appendix  A3. 

SEDEP  (P,  M,  X,  XS,  K,  J) 

P,  X  -  Input  parameter  and  state  vectors 

M    -  Location  of  first  secondary  drag  parameter  in  P, input 

XS   -  Output  of  selected  derivative  of  the  K-th  term  with 

respect  to  the  J-th  parameter 
K    -  Input  index  of  the  K~th  vehicle  force  or  moment  term 
J    -  Input  index  of  the  J-th  secondary  drag  parameter 
This  chapter  has  presented  a  basic  description  of  subroutine 
OVDER  and  its  associated  primary  subroutines  XDDER,  XFDER,  and  XPDER. 
The  Fortran  IV  statements  for  OVDER  and  its  associated  subroutines 
described  in  this  chapter  are  presented  in  Appendix  A8„  The  next 
chapter  presents  a  basic  description  of  the  effector  gradient  sub- 
routines which  are  used  by  OVDER  in  calculating  the  gradient  matrix  F. 
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CHAPTER  1)6 

EFFECTOR  GRADIENT  SUBROUTINES 

The  subroutines  which  are  callod  by  OVDER  as  effector  gradient 
subroutines  are  SHDER,  PRDER,  THDER,  PRDEP,  and  THDEP.  A  basic 
description  of  each  of  these  subroutines  will  be  presented  in  this 
chapter  as  an  aid  in  understanding  and  using  these  subroutines.  The 
Fortran  IV  statements  for  these  subroutines  are  presented  in 
Appendix  A9« 
D6.1  SUBROUTINE  SHDER 

Subroutine  SHDER  is  mathematically  the  most  complex  vehicle 
subroutine  in  this  thesis.  The  complexity  arises  from  the  two 
transformations  and  the  nature  of  the  shroud  angular  functions. 
SHDER  computes  the  partial  derivatives  of  the  shroud  forces  and 
moments  with  respect  to  the  primary  vehicle  states.  These  partial 
derivatives  represent,  quite  literally,  the  partial  derivatives  of 
equations  D3.3  through  D3.12.  A  complete  description  of  SHDER  is 
not  presented  here,  but  enough  of  the  partial  derivative  equations 
axe  presented  to  facilitate  understanding  and  utilisation  of  the 
subroutine  when  compared  with  SHCAL  in  Chapter  D3.3« 
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**T  <K  <K    5*i  1)6.9 
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Equations  D6.1  through  D6.12  in  conjunction  with  equations  D3.3 

through  D3.12  represent  the  essence  of  the  shroud  and  shroud  derivative 

calculations.  Subroutine  ASDSR  is  a  grouping  and  calculation  of  several 

of  the  a  equations  for  convenience.  Subroutine  UTCOM  computes  the 
s  ' 

product  of  the  three  matrices  in  equation  D3*3«  Subroutine  RGCOM 

is  used  by  SHDER  to  compute  the  lift  and  drag  coefficients  along  with 

their  derivatives  with  respect  to  a  •  Subroutine  A3INV  is  a  general 

s 

3*3  matrix  inverter,  and  subroutine  GHPRD  is  a  general  matrix 

multiplier  from  the  IBH/SSP. 

SHDER  (P,  M,  X,  U,  N,  KS,  NLf  ND,  NDL,  NDD,  XSD,  KB,  L) 
P,  X,  U,  KB,  L  -  Same  as  OVMO.D,  Chapter  D2 
M  -  Location  of  the  first  shroud  parameter  in  P 
N  -  Location  of  the  first  shroud  angle  in  U 
NS  -  Number  of  shroud  angles 

NL  -  Number  of  lift  coefficient  straight  line  regions 
ND  -  Number  of  drag  coefficient  straight  line  regions 
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NDL  -  Number  of  lift  coefficient  derivative  straight  line 

regions 

NDD  -  Number  of  drag  coefficient  derivative  straight  line 

regions 
XSD  -  Output  shroud  derivative  vector,  equation  D6.1 
D6.2  SUBROUTINE  PRDER 

Subroutine  PRDER  computes  the  derivatives  with  respect  to  the 
primary  states  of  the  propellor  forces  and  moments.  These  derivatives 
are  calculated  by  branching  to  the  proper  functional  partial  deriva- 
tives of  equations  D3d3  through  D3.16, 
PRDER  (Pf  M,  X,  U,  N,  NP,  XP,  K) 

P,  M,  X,  U,  N  -  Same  as  in  SHCAL,  Chapter  D3,  except  N  =■  (10) 
NP  -  Number  of  propellor  inputs  (2) 
XP  -  Output  partial  derivative  $X'       /<)*• 
K  *  Indexes  of  desired  partial  derivatives,  1  <  K  <  36, 
(1,  j)  «  E  -  1  +  6(j  -  1) 
D6.3  SUBROUTINE  THDSR 

Subroutine  THDER  computes  the  derivatives  of  the  thruster  forces 
and  moments  with  respect  to  the  primary  states  of  the  vehicle.  These 
derivatives  are  calculated  by  branching  to  the  proper  partial  deriva- 
tives of  equations  D3,17  and  D3S18  and  then  by  using  subroutine  RGCOM 
to  compute  the  thruster  coefficient  derivatives  as  straight  line 
approximations  of  the  curves  in  reference  (B~9)« 
THDER  (P,  M,  U,  N,  X,  XT,  K) 

P,  M,  U,  X  -  Same  as  SHCAL,  Chapter  D3 
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N  -  Same  a^  NT  In  XPDER,  Chapter  D^.j? 

j 
XT  -  Output  partial  derivative  ^X',  /Ax 

th'u   j 

K  -  Same  as  PRDFR,  Chapter  D6„2 
D6 . 4  SUBROUTINE  PRDSP 

Subroutine  PRDSP  computes  the  derivatives  of  the  propellor  forces 
and  moments  with  respect  to  the  selected  propellor  parameters.   These 
derivatives  are  calculated  by  branching  to  the  proper  functional  par- 
tial derivatives  of  equations  D3.13  through  D3„l6. 
PRDEP  (P,  M,  X,  U,  N,  NP,  XPf  Kt   J) 

P,  M,  X,  U,  N  -  Same  as  in  SHCAL,  Chapter  D3,  except  N  -  (10) 
NP  -  Number  of  propellor  inputs  (?) 
XP  -  Output  partial  derivative  ^x\  /^p . 

r         if  x) 

K  -  Index  of  force  or  moment 
J  -  Index  of  parameter 
D6.5  SUBROUTINE  TKDBP 

Subroutine  THDEP  computes  the  derivatives  of  the  thruster  forces 
and  moments  Kith  respect  to  the  selected  thruster  parameters.  These 
derivatives  are  calculated  by  branching  to  the  proper  partial  deriva- 
tives of  equations  D3.17  and  D3,18  or  else  by  using  subroutine  RPDSR 
to  calculate  the  parametric  derivatives  of  the  straight  line  approxi- 
mations of  the  thruster  coefficients, 

TKDSP  (P,  M,  U,  N,  X,  XT,  K,  J) 


P,  M,  U,  N,  X  -  Same  as  THDER,  Chapter  D6,3 

J 


XT  -  Output  partial  derivative  JY.^/dv. 


K,J  -  Same  as  PRDSP,  Chapter  D6.4 
This  chapter  has  presented  a  basic  description  of  the  DSRV 
effector  gradient  subroutines.  The  Fortran  IV  statements  for  the 
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effector  gradient  subroutines  described  in  this  chapter  are  presented 
in  Appendix  A9.   The  next  chapter  describes  methods  for  modifying 
all  of  the  D3RV  subroutines  for  use  vrith  other  ocean  vehicles  and 
suggests  several  programming  simplifications  which  could  be  applied 
to  the  DSRV  model  subroutines. 
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CHAPTER  D7 

PROGRAM  SIMPLIFICATIONS  AND  MODIFICATIONS 

The  purposes  of  this  chapter  are  to  describe  the  modifications 
necessary  to  OVMOD  and  OVDER  for  calculation  of  vehicles  other  than 
DSRV  and  to  recognize  that  these  subroutines  have  several  possible 
program  simplifications, 
D? •  1  PROGRAM  SIMPLIFICATIONS 

Subroutines  OVMOD  and  OVDER  along  with  their  associated  subroutines 
were  written  and  debugged  separately,  directly,  and  suboptimally.   As 
written,  however,  they  do  their  jobs,  and  so  the  author  has  not 
devoted  any  extra  time  to  "cleaning  up  the  code,"  reducing  the  number 
of  cards,  or  speeding  them  up. 

The  most  obvious  and  potentially  profitable  work  to  be  done  is 
the  combination  of  OVMOD  and  OVDfiR  into  a  single  subroutine.  Several 
of  the  functions  computed  by  each  are  identical,  and  many  of  the 
variables  computed  by  one  can  be  used  by  the  other.  Some  provision 
should  be  made  in  the  combined  subroutine  to  allow  deferring  calcu- 
lation of  the  gradient  when  the  model  is  to  be  used  in  a  model  reference 
framework* 

Another  sat  of  possible  simplifications  arises  from  the  fact 
that  all  of  the  equations  were  written  out  complete] y  in  several 
cases  and  not  combined  by  type.   An  example  of  this  is  in  ACALC, 
where  AC  =  0.  appears  many  times  and  could  be  written  only  once  with 
proper  changes  in  the  initial  conditional  GO  TO  statement  numbers. 
Several  other  subroutines  to  which  this  simplification  would  apply 
are:  XFUNS,  COCAL,  XDFNS,  XPDER,  and  PRDER. 
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In  several  subroutines,  there  ere  sections  containing  the  same 
or  nearly  the  same  sequence  of  steps.  These  could  perhaps  be  simpli- 
fied by  making  those  sections  into  subroutines.  For  example,  in 
subroutine  THCAL  there  are  several  groups  of  about  20  statements 
each  which  have  somewhat  the  same  structure  and  could  be  rewritten 
into  a  subroutine.   The  noisy  and  noiseless  sections  of  0VK0D  could 
also  be  combined  into  a  single  subroutine. 

It  is  now  evident  to  the  author  that  there  are  several  sub- 
routines which  contain  unnecessary  conditional  GO  10  statements  and 
ISW  indicators.  An  example  of  this  is  in  subroutine  SECAL,  where 
the  first  conditional  GO  TO  (2,3)  ISW  is  unnecessary  if  in  the  two 
preceeding  statements  the  ISW  =  's  were  changed  to  GO  TO  *s.   In 
fact,  one  of  the  two  preceeding  statements  could  also  be  dropped. 
This  type  of  simplification  is  evident  elsewhere  in  SECAL  as  well 
as  in  several  other  subroutines, 
^ • 2  ™pRAM  MODIFICATIONS  FOR  OTHER  OCEAN  VEHICLES 

The  keynotes  of  OVKOD  and  OVDEfi  as  written  are  structure  selectiv- 
ity, second-degree  coefficients,  and  BSRV  effectors.  Any  potential 
user  of  these  subroutines  who  does  not  require  structure  selectivity 
for  reducing  the  parameter  space  would  be  well  advised  to  write  his 
own  OVMOD/OVBER  rather  than  trying  to  modify  this  one.  The  entire 
fabric  of  these  two  subroutines  is  woven  from  structure  selectivity 
statements  and  a  considerable  percentage  of  the  computation  time 
(est,  20-30;$)  is  spent  selecting  structure. 

Any  potential  user  who  requires  linear,  third-degree,  fourth- 
degree,  etc, ,  coefficients  or  who  does  not  require  second-degree 

coefficients  would  have  to  rewrite  XDCAL,  XDDSR,  and  XFDER  based  upon 
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the  requirements  of  his  model.   It  is  anticipated  that  the  program- 
ming necessary  to  include  additional  coefficients  will  be  6traight- 

foreward  extension  of  the  techniques  used  for  the  second-degree 
coefficients. 

The  DSRV  effector  subroutines  will  not  be  applicable  to  most 
other  ocean  vehicles.   The  TANKS,  GRAVT,  and  COCAL  could  probably 
be  used  directly  for  any  ocean  vehicle,  but  the  SHCAL,  SEGAL,  PRCAL, 
and  THCAL  (shroud,  secondary  drag,  propeller,  thrusters)  subroutines 
are  specific  to  the  DSRV,  Anyone  wishing  to  use  OVMOD/OVDSR  should 
write  effector  subroutines  specific  to  his  vehicle  and  include  param- 
eters and  calling  statements  in  OVMOD  and  OVDER, 
D7.3  SECTION  5(D) ...  SUMMARY 

This  section  has  presented  the  detailed  equations  for  calcula- 
tion of  the  time  derivatives  and  their  gradients  of  the  linear  and 
angular  velocities  of  a  general  ocean  vehicle.  A  subroutine  for 
calculating  the  linear  and  angular  accelerations  (OVMOD)  has  been 
presented  and  its  use  explained,  A  subroutine  for  calculating  the 
gradient  with  respect  to  states  and  parameters  of  the  linear  and 
angular  accelerations  (OVDER)  has  also  been  presented  and  its  use 
explained.   Effector  subroutines  specific  to  the  DSRV  have  been 
included  for  both  OVMOD  and  OVDSR  and  explained,   The  Fortran  IV 
statements  for  these  chapters  are  found  in  Appendices  A6  -  A9» 

The  next  section  6(C)  presents  the  programming  and  analysis 
for  utilization  of  these  model  and  gradient  subroutines  In  the  iden- 
tification and  identifiability  studies  of  the  DSRV  coefficients  and 
parameters. 
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SECTION  6 


IDENTIFICATION  STUDIES  OF  THE  DSRV  DYNAMIC  COEFFICIENTS  (C) 

CI   MAIN  6*6  IDENTIFICATION  PROGRAM  DESCRIPTION  AND  SEA 
TRIALS  (MAIN) 

C2   MODEL  REFERENCE  CONTOURS  FOR  SELECTED  DSRV  6*6  PARAMETERS 

C3   DESCRIPTION  OF  SEVERAL  SUBROUTINES  FOR  USE  IN  THE  MAIN 
PROGRAM 


"THE  PURPOSE  OF  COMPUTING  IS  INSIGHT,  NOT  NUMBERS."   - 

R.  W.  HAMMING     (H-5) 


THIS  SECTION  PRESENTS  A  DESCRIPTION  OF  AND  SOME  RESULTS  FROM  A 
STRUCTURE-SELECTIVE  SIX  DEGREE  OF  FREEDOM  IDENTIFICATION  PROGRAM 
WHICH  USES  THE  DSRV  MODEL  OF  SECTION   5(D).      THE  COMPUTER  RUNS  ARE 
DESIGNED  TO  SHOW  HOW  THE  PRIMARY  VEHICLE  BEHAVIOR  CHANGES  AS  MORE 
DEGREES  OF  FREEDOM  ARE  INCLUDED  AND  TO  SHOW  THE  MODEL  REFERENCE 
CONTOURS  OF  SEVERAL  SELECTED  DSRV  COEFFICIENTS  AND  PARAMETERS   IN 
MULTIPLE  DEGREE  OF  FREEDOM  MODELS. 
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CHAPTER  CI 

MAIN  6*6  IDENTIFICATION  PROGRAM  DESCRIPTION  AND  SEA  TRIALS  (MAIN! 

The  extensive  studies  of  Section  4(P)  have  shown  that  the  model 
reference  contouring  and  extended  Kalman  filtering  technqiues  are 
valid  for  the  DSRV  single  degree  of  freedom  equations.   This  section 
shows  that  the  model  reference  contouring  technique  is  valid  for  the 
DSRV  in  one  through  six  degrees  of  freedom  for  several  selected  coeffi- 
cients. The  DSRV  mathematical  model  has  been  presented  and  its  sub- 
routines described  in  Section  5(d);  this  model  is  used  in  the  main  six 
degree  of  freedom,  structure-selective  identification  program  developed 
for  the  studies  of  this  section. 

This  chapter  presents  a  description  of  the  DSRV  sea  trial  behavior 
in  1  through  6  degrees  of  freedom  using  a  simulated  ramp  input  to  the 
DSRV  propellor,   A  description  of  the  MAIN  program  for  generating  this 
data  and  for  identifying  selected  vehicle  parameters  from  it  using 
model  reference  contouring  is  also  presented.   The  next  chapter  shows 
the  identification  results  from  using  the  model  reference  contouring 
technique  on  multiple  degree  of  freedom  sea  trials  and  mathematical 
models, 
CI .  1  DSRV  SEA  TRIALS  IN  1  THROUGH  6  DEGREES  OF  FREEDOM 

The  flexibility  of  the  main  program  to  be  described  in  Chapters 
CI. 2  and  Cl<>3  allows  the  running  of  DSRV  sea  trials  using  models  with 
1»  2,  3,  k,    5,  or  6  degrees  of  freedom  using  the  same  input  function. 
This  offers  a  useful  set  of  results  in  that  the  vehicle  coupling  and 
decoupling  may  be  observed.  For  example,  if  the  surge  velocity  is  the 
same  for  a  1  degree  of  freedom  (DOE)  model  as  it  is  for  a  6  DOF  model, 
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then  the  identifiability  characteristics  of  the  directly  related 
parameters  in  surge  for  1  DOF  should  be  applicable  to  the  same  param- 
eters in  6  DOF  for  the  same  maneuver. 

The  input  function  to  be  used  in  these  runs  is  a  simulated  ramp 
function  to  the  DSRV  propellor.   This  input  function  is  plotted  as 
curve  #1  in  Figure  Cl.l,  and  the  propellor  angular  acceleration  is 
shown  by  curve  #2  in  Figure  Cl.l.   This  input  will  remain  the  same 
for  all  of  the  sea  trials  described  in  this  chapter. 

Using  the  input  in  Figure  Cl.l  and  the  MAIN  program  (primarily 
subroutine  SEATR)  of  Appendices  A19  and  A17,  the  DSRV  sea  trials  for 
46  seconds,  without  any  control  systems  or  tanks  inputs,  were  calcu- 
lated using  1,  2,  3i  ^i  5»  an&  6  degree  of  freedom  models.   Fculated and contoured for each pass. A brief description of MAIN 
and some of its input data formats will be presented here. A sample 
input data deck for running the DSRV in 1 through 6 DOF blocks and 
identifying several selected coefficients in each block is given in 
Appendix A,20. 

f 

Program MAIN begins with a list of declaration statements which 
include some variables (such as EH) which are not used for model 
reference contouring but which would be required for an extended 
Kalman filter to be included in MAIN. Next, the program reads in 
the initial data, sets variables to zero, and writes out the initial 
data for reference. Then preparations are made for running the blocJc 
sea trial by initia-lizing selected variables and reading in changes 
to selected variables for that block. Next, a complete description 
of the sea trial block is written out; one small portion of this 
description is shown in Figure Cl, 20, vjhere the 6 DOF m.odel is to be 
run with secondary drag, prop, shroud, and no-noise effectors and 
with coefficient to be identified. Host of the block description 
is written out in formats v/hich are specific to the DSRV effectors, 

Ihe next major step in MAIN is the running and plotting of a sea 
trial using subroutines SEATR (Chaptex' C3, Appendix /vl?) and STOUT. 
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Ihe sea trial data may nov; be used in identification passes by model 
reference contourin^j or by extended Kalman filtering, Ihe extended 
Kalman filtering section of MAIN was not completed prior to the vrriting 
of this thesis, but sevex'al applicable subroutines are included in 
Appendix Al8, 

The model reference contouring steps begin by rea.ding in the 
indexes of the coefficients or paj?ameters to be varied and contoured 
along with the v:eighting matrix for the cost function calculation. 

After writing out the characteristics of the coefficients or param- 
eters being varied, a mathematical model sea trial is run using the 
inputs previously generated by subroutine SEATR and using subroutine 
HOREF (Appendix Al?, Chapter C3)* The trajectories generated by the 
"vehicle" in subroutine SEATR and the "model" in MOREF are then used 
to calculate the weighted integral square cost function. Finally, 
the values of the cost function are contoured and, if desired, vertical 
or horizontal slices of the contourjts are plotted. In addition, the 
logarithm of the cost function is calculated, contoured, and sliced if 
TOUT (3) is set to 1. 

Cl . 3 DB3CRIPTI0K OF THE INPUT DATA FOR MAI N 

This description goes card by card tlirough the sample input data, 
deck of Appendix A19 shovring the foi'mats used and describing the 
important variables for each card. 

Card §1 Format (?.0I4) 

KS - Number of primary states 

KME - Number of effector designators 

KAV - Number of second degree coefficients 
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KNB 


- Niunber of effector group designators 


MP 


- Location of 1st parameter in P 


KHV 


- Number of tlie first parameter group index in ME 


KMP 


- Nximber of parameter gi'oup designators in ME 


KPF 


- Number of parameters in the final parameter group 


KX 


- Total number of states 


KPG 


- Number of elements in PG used in OVHOD 


KU 


- Number of input variables in U 


NHMAX 


- Number of input samples,* 18 * 


NIND 


- Number of integer changes per cai’d 


NIN 


“ Number of variable changes per card 


NST 


) 

*' Number of step function designators for UINPT 


NOUT 


- Number of output designators 


NBLT 


- Number of letters in vjord BLOCK 


KNP 


- Number of parameters P ; 


NHRT 


- Number of letters in v:ord PASS 



Card # 2 . Format (2014) 



MREF 


- Model reference designator 


KFIL 


- Kalman filter designator 


lONE 


- Initially set to 1 


NCN 


- Number of values of 1st parameter to be contoured 


NCD 


- Number of values of 2nd parameter to be contoured 


NMR 


- Number of data points in model reference calculations 




- Initially 1 


ITKRE 


- Initially 3 


KUA 


- Location of angles in input U 
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Caid n Format (415. 2PII0.2) 



ISIXT - Initially 15 

ISEVT - Initially l6 

KEK - Dimension of EH; for Kalman filtering 
KEF ~ Dimension of E and F; for Kalman filtering 

EPS - Program zero plus; 0'^ 

EMAX “ Program maximum for the states 
Card //4 Format (2014) 

NGPI - Number of elements in MGP(j), NGP(j) 

MGP(j) “ Locations of parameters to be described in groups 
Card Format (2014) 

NGP(j) - Number of parameters in each group to be described 
in block output 

Card #6 Format (401?^) 

M(J) - Initial designators for the structure selector 
Card #7 Format (2014) 

ME(J) - Effector designators; Chapter D2 
Cards #8 - 11 and 12-15 Format (4012) 

AV(J), XF(j) - Chapter D2; Appendix A2 
Card ,n6 Format (4012) 

NE(J) - Chapter D2 
Cards ^17 - 80 Format (10F8.2) 

P(j) - Vehicle parameter vector; in groups; A.ppendix A3 
Cards #81 - 106 Format (10F8 c2) 

X(j) - Vehicle state vector; Appendix A1 
Card #107 Format (10F8.2 ) 

PG(j) - Vehicle gravity vector; Cha.ptor D2 
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Cards ^08 - 109 Format (I0F8.2 ) 

US(j) - Initial values of the vehicle inputs 

Cards #110 - 135 Format (10F8.2) 

XINC(J) - Model reference increments of tlie state variables; 
Appendix A3. 

Cards #136 - 194 Format (10F8.2) 

PINC(j) - Model reference increments of the vehicle 
parameters; Appendix A1 

Cards #195 ~ 246 Format 5(l5<Fll«4) 

J,XS(j) - Starting model reference state variables; 

Appendix A1 

Cards - 364 Format 5(l5.m,4) 

J,PS(J) - Starting model reference parameters; Appendix A1 
Card #365 Format (2014) 

NB - Number of blocks to be processed in this computer run 
Card ^366 Format (8O/J.) 

BLOCK - Test vrord to maJce sure that the above data has been 
read in properly 

At this point the actual BLOCK and PASS data is included for the 
sea trials and model reference passes over the sea trial data. Each 
block may have multiple passes, but no pass may apply to more than one 
block. Only the cards for the first block and for the first pass will 
be described in detail here. The format for the other blocks and 
passes is the same. The blocks and passes in Appendix A20 are those 
used to generate the 1 through 6 degree of freedom sea trials of this 
chapter and many of the identification passes described in the next 
chapter. The MAIN program’, its subroutines, and the input cards of 
Appendix A20 required 1 hour of IBM 360/65 computation time -with 
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Fortran G (Fortran H won't compile MAIN due to its size.) and gener- 
ated 30 thousand lines of output descriptions, plots, and contours. 

Card in(>7 Format (20l4 ) 

NBLOK - Block designation number 

NPB - Number of model reference passes in the block 
The remainder are initializing integers; 0 initialize that vector 
Card //3o8 Format 10 (I4,l4) 

K,M(k) - Card form for reading changes to the structure-selector 
vector M(6); this form is used in many of the following 
vectors and reads changes by index directly into the 
vector until a 0 index is found either within the format 
or on a follovring blank card. 

Card #369 Format 10(l4,l4) 

K,HE(K) -Changes to the effectqr selection vector 
Card ^370 Format (1QF8.2) 

TZ - Time zero for this block 

DT - Time increment for this block 

Card #371 Format (2014) 

NDT - Number of time increiaents in the sea trial 

KF - Number of coefficients to be identified 

KP - Number of parameters to be identified 
Card #372 Format 10(l4,l4) 

K,LF(k)- Changes to the coefficient identification vector 
Cai'd ^373 Format 10(l4.l4) 

K,LP(k)- Changes to the parameter identification vector 
Card #374 Format 3(15. Fll, 4) 

K,X(k) - Changes to the starting state vector for the sea trial 
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Card //375 Format 5(l5,F11.4) 

K,P(K) - Changes to the starting pn.ramctcr vector for tho sea 
trial 

Card y^376 Format 5(l5.F11.4) 

K,Q(K) ■* Changes to the k noise generation vector 

Card ^377 Format 5(l5.Fll,4) 

K,r(K) - Changes to the v noise generation vector 

Card //378 Format 5(I5.FH.4) 

K,U(K) - Changes to the initial input vector 

Card3,»=379 - 381 Format 5(l5. F11.4) 

K,TST(K) “ ChaJiges to the input step function stsirting times 
vector 

Cards >^382 - 384 Format 5(l5.F11.4 ) 

K,UST(k) - Changes to the input step function amplitudes vector 
Card #385 Format 5(l5tFll«^) 

K,XH(K)“ Changes to the starting state vector for model reference 
contouring or for extended Kalman filtering 

Card //386 Format 5(I5.F11,4) 

K,PH(K)- Changes to the starting parameter vector 

Card ,^337 Format 5(l5.FHc4) 

K,EH(K)- Changes to the starting error covariance matrix 

Card #388 Form.at 5(l5.FH.^O 

K,QJ'!(K)~ Changes to the extended Kalman fi].ter Q matrix 

Card ;^389 Format 5(l5.FH.4) 

K,RN(K)- Changes to the extended Kalman filter R matrix, or 
to the model reference weighting matrix 



- 329 - 








»»• ••O'' 



Card #390 Format 10 (j>,l4) 

K,I0UT(K) “ Changes to the output designation vector 



I0UT(1) - Logarithmic contours 
I0UT(2) - Input function plots 
I0UT(3) ” Contour slices plotted 
lOUT(h-) - Vehicle angles plotted 
I0UT(5) - X, XH, P, PH, EH data listed 
Card #391 Format (80A1) 

BLOCK - Test card at the end of each set of block data . 

The pass data for this block is inserted here. The first 
pass in each block of Appendix A20 is set up to contour or 
identify the coefficient and the parameter X^, 

Card #392 Format (2014) 

KF ~ Number of coefficients to be identified in this pass 

KP - Number of parameters to be identified in this pass 

Card #393 Pbrmat 10(l4,l4) 

K,LF(k)“ Indexes of the coefficients (part of the state vector X) 
to be identified in this pass 

Card #394 Format 10(l4,l4) 

K,LP(K)- Indexes of the parameters to be identified in this pass 
Card #393 Format 5(I5.F11.4) 

K,RN(K)~ Vfeighting matrix changes for this model reference pass 



Card #396 Format (80Al) 

PASS - Test card at the end of each set of pass data 

Ihis chapter has presented plots and discussions of the dynamic 

behavior of the DSRV for a simulated ramp input in 1 through 6 degree 

of freedom models. Then the MAIN program for generating these sea 

trials and for identifying selected vehicle parameLers using model 
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reference contourins vfas described briefly with regard to its progran- 



ming and described in detail with regard to its input data cards, Tiio 
next chapter discusses the identification results from using the model 
reference contouring technique on mifLtiple degree of freedom sea trials 
and mathematical models. 
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CHAPTER C2 



MODEL RBFERSNCE CONTOURS FOR SELECTED D5RV 6*6 PARAHCTl'JRS 

This chapter is the culmination of the practical results of 
this thesis, and it shows that the technique of model reference con- 
touring works extremely well for identifying DSRV parameters in models 
containing as many as six degirees of freedom, Ihe model reference 
contouring technique used here has been descx'ibed in detail in 
Chapters N2 and P3, and the structure-selective DSRV mathematical 
model has been presented in Section 5(D) « The MAIN program and its 
input data cards have been discussed in Chapter Cl, 

Ihe coefficient and parameter studies to be described in this 
chapter represent only a small part of the useful results for the 
DSRV which could be obtained using program MAIN and subroutine OVKOD. 

A large poi'tion of the effort in this thesis development was devoted 
to the writing and debugging of these programs, and the studies made 
here were done so primarily for the purpose of showing that the method 
and the programs are valid for the DSRV, The results of these studies 
are presented in the remainder of this chapter by discussing the param- 
eters one after another starting with those identified in the 1 through 
6 DOF sea trials of Chapter Cl,l, 
and P(229) 

DSRV coefficient (-16,7) is the vehicle primary drag coeffi- 
cient and P(229) (755.) is the main propeller thrust coefficient. 

Both of these parameters were studied in great detail in Section 4(P) 
for different input functions and different identification methods. 

The eleven-by-eleven contours for the identification of and P(229) 
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using thG simulated ramp input function, no noise, and the DSRV 6 
DOF model (responses in Chapter Cl.l) are shovm in Figure C2.1. 

“Ihere are fewer contour points in Figure C2.1 than there were in 
the contours of Chapter P3 because each point is more costly to gen- 
erate for 6 DOF"’ and because it is still possible to identify the 
parameters using fewer points if logarithmic contours are also plotted. 
Figure C2,l has a shape somewhat similar to that of Figure P3.13 for 
the staircase function input except that the bottom of the contours in 

Figure C2,l is much flatter, making X hard to identify. Five vertical 

uu 

slices of Figure C2,l are shovm in Figure C2,2, and five horizontal 
slices of Figure C2,l are shown in Figure C2,3t These slices show the 
vertical "trougii" shape of the contours in Figure C2,l clearly, along 
with the minimum (10“^) and maximum (5«9) values. 

One way to greatly accentuate the minimum values for model refer- 
ence contouring is to contour log^ C(o) vs the parameter values as in 
Figure C2,4 (D-13), Five vertical slices of Figure C2,4 are shown in 
Figure C2,5, and five horizontal slices of Figure C2.4 eir’e shown in 
Figure 02,6, The minimum value in Figure 02,4 is seen to be exactly 
at (-16,7, 755*)f whereas in Figure 02.1 only P(229) is identifiable 

(755.). 

Identifications were made of and P(229) using the 1 through 6 
DOF runs described in Ohapter 01.1. Tne contours and their logarithms 
were eilmost identical in shape for these six cases to Figures 02.1 and 
C2.4, and the minimum and maximum values corresponded very closely* as 
seen in Table 02,1, Tbese results shovf conclusively that the identifi- 
ability studies of X and P(229) for the 1 DOF model may be directly 
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DOF 


1 


2 


3 


4 


5 


6 


Minimum C(£) 


10-12 


10 -12 


O 

1 


10“9 


10-1-1 


10"^ 


Maximum C(j)) 


4.9 


6*0 


4.9 


6.1 


6.1 


5.9 



Table C2.1 CONTOUR VALUES FOR AND P(229), 1 THROUGH 6 
DOF MODELS 



extended to apply to the 6 DOF model. Therefore, if noiseless real 
DSRV data were available for this maneuver and if the structure of 
the DSRV model v;ere exactly the same as the real vehicle, then the 
parameters and P(229) identified by model reference 1 DOF con- 
touring would be the correct ones for the 6 DOF vehicle. 

The same conclusions cannot be reached vfhen noises are introduced 

I 

into multiple degree of freedom models and data. Only.a fev; multiple 
DOF runs ^;ere made with noise for this thesis, and those indicated 
that for these tv:o parameters and severaJ. others the %v and noises 
tend to make the parameters significantly less identifiable in multiple 
DOF models than in single DOF models due to the noise being coupled 
through the various states throughout the maneuver. More extensive 
noise studies could now be made using the progi'ams of this thesis to 
determine how the noise is coupled into various states and parameters, 
\ (- 144 ) 

The next coefficient studied in detail for multiple DOF moaeis 
was the DSRV surge ** added mass** coefficient This term enters into 

the DSRV surge 1 lOF model as shown in equation C2dt The fact that 
is only 3*3/5 of the vehicle mass m tends to obscure it slightly when 
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" ^ " ^u|u| P(?'29) n|n| + P(230) n u + P(?,3l)u^ 

C2.1 

'^Tiere; m - D3RV mass; 4363 . slugs 

= DSRV added mass in sux'ge; -144, slugs 
\ |u| “ <irag coefficient; - 16,7 

P(229) = Propeller primary thrust parameter; 755 . 

P(230) - Propellor cross thrust parameter; - 58 . 

P(23l) = Rropellor surge thrust reduction parameter; - 3.8 
n = Propeller revolutions per second 
u = Surge velocity ft/sec 



attempts ea'e made to identify it, especially for noisy sea trials. 

Ihe 6 DOF contours for X (-I 6 . 7 ) and X* (-144,) for the DSRV 

are shown in Figure C2,7» where the minimum value is 10 “^ and the 

maximum value is O.O 3 . The 1 through 6 DOF contours are almost 

identical to Figure C2,7i with the same maximum- minimum values. The 

very flat bottom of the trough in this figure shows that X^ is not 

easily identified, and the partial linear dependence (Figxrre N4,4, ;^9) 

indicates that X,,,, and X* are coupled for this maneuver and could not 
uu u 

be properly identified separately. Noise studies have shown that for 
3^v and 3^w noises, X can be identified to within 3^ but X; cannot 
be identified to better than accuracy. However, even at 1,3 times 
its true value X^ is still only oT equation C2,l. 

P(230) AND P(23l) IN SQIUATION C2.1 

The secondary propellor thrust parameters P(230) and P(23l) in 
equation C2,l reveal more dramatically the results of parameter coupling 
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(i,e. linear or functional dependence). Ihe 4 DOF contours for these 
two parameters are presented in Figures C2.8 and C2.9, and both show 
partially linear coupling betvfeen X,.„ and P(230) and betv;een X and 
P(23l). The logarithmic contours in both of these cases permitted 
perfect identifications of both prcpellor pai-ameters, but it still 
may be concluded that for this maneuver the values of X^^, X^, P(230) , 
and P(23l) identified in pairs from noisy data vfould probably not be 
the true values. In other words, to find these four parameters v.'hen 
the data is noisy, a scheme (such as extended Kalman filtering) vfhich 
varies all four parameters at once should be used. Hovfever, it is 
extremely helpful that model reference contouring provides concli:sions 
of this type. Contours identical to Figures C2.8 and C2.9 v;ere also 
generated using 1, 2, and 3 K)F models, indicating that the above infor- 
mation could have been obtained from 1 DOF studies, 

3 DOF IDENTIFICATIONS; SURGE, HEAVE. PITCH; NO NOISS 

The DSRV parameters which were identified using the simulated 
ramp input and 3 DOF model are listed in Table C2,2. Ihe author was 
somewhat surprised to see the amount of information in terms of paraim- 
eters which couI.d be extracted from three plots (Figures Cl, 2, C1.5» 
and Cl, 6) containing 46 points each, Ihere are probably several more 
parameters vjhich could have been identified using this same set of 
data. Ihe reail identification "power" comes from the fact that the 
structure used to generate the data is exactly (no noises) the sane 
as that in the model and from the fact that the parameters were varied 
two at a time with the ones not being varied having been set to their 
"true" values for the identification pass. Another helpful factor 
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Parameter 


Location 


True Value 


Comments 


^^shroud 


P(150) 


-24.59 ft. 


Location of the shroud; perfect 
identification 


M* 

q 


P(29) 


-4.1*10^ 


Perfect identification 


X 

wq 


X(19) 


- 3600 . 


Perfect identification 


Z 

q 


P(17) 


- 770 . 


Perfect identification 


X 

uu 


X(7) 


- 16.7 


Perfect identification; used log 
contours with P(229) 


X. 

u 


P(l) 


-144. 


Perfect identification; highly 
noise susceptible 


P(229) 


P(229) 


755. 


Perfect identification; pfopellor 
thrust coefficient 


P(230) 


P(230) 


-58. 


Log contour identification; linear 
dependence with X^^^ 


P(23l) 


P(23l) 


-3.8 


Log contour identification; linear 
dependence with X^^ 


V 


X(21) 


-770. 


Perfect identification 


M* 

w 


P(27) 


- 770 . 


Perfect identification 


Z 

uu 


X(49) 


2.43 


Log contour identification 


W 

0 


P(578) 


140369 Ibf, 


Perfect identification; DSRV 
equilibrium weight 


Z 

uvr 


X(52) 


-55.9 


Perfect identification 


Z 

uq 


X(59) 


-444. 


Perfect identification 


Z 

vrw 


X(54) 


- 207 . 


Perfect identification 


M 

uu 


X(91) 


- 66 . 


Perfect identification 


M 

uw 


x(94) 


2760 . 


Perfect identification 


M 

uq 


X(lOl) 


-26600 


Perfect identification 


"g 


P(58l) 


0,1335 ft. 


Log contour identification; 
location of C.G. on DSRV 





P(15) 


-3600. 


Perfect identification 



Table C2.2 DSRV PARAMETERS IP'r^IimFIED UHING 3 DOFr_NO _NQISg 
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was that without the very fast roll dynamics of other DOF models, the 
Euler integrator with a 1 second time step vjas able to more accurately 
solve the 3 DOF model. In any case the validity of the technique and 
of the computer programs has been demonstrated for multiple degree 
of freedom models. 

This chapter has presented identifications in multiple degrees 
of freedom which validate the model reference contouring technique as 
a means of studying parametric identifiability for combinations of 
tvfo peirameters at a time. This essentially completes the presentation 
of practical resuD.ts from the studies of this thesis. The next 

chapter describes several of the subroutines used in these multiple 

» 

degree of freedom studies with either model reference contouring or 
extended Kalman filtering. 
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CHAPTICR C3 



pascfiiPnoN OF sb\'sral subroutines for USP] in thb main phograk 

This chapter very briefly describes the input-output charac- 
teristics of some subroutines developed for use in the main model 
reference program (vrritten and used in this thesis) and for use in 
an extended Kalman filtering program (uncompleted). 

C3.1 SUBxROUTlNSS FOR MODEL RSFSRENCP] CONTOURING 

The detailed statements for subroutines SEATR, UINPT, HOREF, 
and STOUT axe presented in Appendix Al?, 

SSATR (U. P. X, XN) 

This subroutine computes the sea trial trajectories (Z, ZN) 
for an ocean vehicle OVKOD in a structure-selected combination of 
6 degrees of freedom using an Euler integrator. First the inputs 
U and the time vector T are generated by subi'outine UINPT. Then the 
ocean vehicle primary state vector X and noisy primary state vector 
XN are propagated from point to point over the length of the sea 
trial using simple Euler integration. These states axe tested 
after each calculation to ensure stability; if the equation becomes 
unstable, integer I is set to 0, and the sea trial is terminated. 
Subroutine SEAl’R also contains internally the capability (MB (19) = l) 
of integrating the resulting vehicle angular velocities to produce 
the true vehicle angles v;hich are used throughout the sea trial. 

Noise raay be added to the sea trial data both in SEATR (V - noise) 
and in OVMOD (W - noise). 

UINPT (TS. USt UZj DT, TZ. T, U) 

Subroutine UINPT computes a time vector (T) and a set of 
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combined, ten-step-function inputs U for use in a sea trial. The 
starting time and input values are designated by TZ and UZ, and the 
ten-step-function times and amplitudes axe designated by TS and U3. 
The time increment is given by DT, and the values of the starting 
times TS must be greater than or equal to 0 for the steps to be 
included in the sea trial. 

HORSF (I. P. x) 

Tnis subroutine is almost identical to subroutine SSATR except 
that no noise is added to the sea trial data, only one set of 
trajectories (x) axe calculated, and no input functions are computed. 
These two subroutines could be combined into a single subroutine if 
the proper selection features were included in the combined sub- 
routine. 

STOUT (T, U. Z. ZN. IU. N, NP) 

This subroutine is used to generate plots of noisy (ZN) and 
noiseless (Z) sea trial trajectories, vehicle angles (U), and vehicle 
input functions (u). These plots aire only generated if the corres- 
ponding states (m) and effectors (ME) were used in the original sea 
trial. Several output comments specific to the DSRV are included in 
this subroutine c 

C3,2 SUBROUTINES FOR EXTENDED KALMAN FILTERING 

Ihe general, structured-selective, six degree of freedom extended 
Kalman filtering section of the program MAIN in Chapter Cl was not 
completed, but the following subroutines which are required for that 
program were written by the author. These subroutines are included 
here because they ax'e completely general and may be useful to anyone 
who is using the extended Kalman filter of Steps K3-9 through N3tl6, 
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The subroutines EUDOT, KGAIN, and UPDAT in Appendix Al8 are com- 
pletely generalized versions of subroutines PROP, EFUN, GAIK, and 
UPDAT in Appendix A14. 

EHDOT (X, U, P, E, XD, EP) 

, ^ 

Subroutine EHDOT computes both E and x of equations N3.15 and 

A. 

N3»l^ using a general ocean vehicle model OVMOD for x = XD and its 
general state and parameter gradient OVDSR for F. The subroutine 
then combines the compressed versions of F and B (Chapter N3) and 
the compressed w^noise covcLriance matrix Q (diagonal) to compute 
E = ED for use in the propagation of the error covariance matrix 
and the state estimates by the main program, 

KGAIN (S, KB, NF, EG) 

This subroutine calculates a special form of equation N3«l6 in 
Step N3«12 using the H matrix in equation N3»21 and the diagonal 
values for the R matrix. This results in the calculation of the 
general filter gain matrix EG using the error covariance matrix E 
(compressed), the number of primary states KB, the matrix R (in 
common), and the total number of primary states, coefficients, and 
parameters NF, If the matrix to be inverted in equation N3»l6 is 
found to be singular, the diagonal is inverted (modified if necessary) 
and. a message is vrritten stating that this was done, 

UPDAT (Z, X. B. EG, XH. EH, KB, NF) 

This subroutine computes the updated values of the states XH 
and error* covariance matrix EH based upon the propagated states X, 
the propagated error covariance matrix E, the noisy measurement of 
the states Z, and the extended Kalman filter gain matrix EG, The 
equations solved by this subroutine are equations N3,l? and N3»lfi in 
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steps N3.13 S'-iid N3.14. 

Ihis chapter has presented brief explanations of subroutines 
S2ATR, UINPT, MOREF, and SIDUT for use in model reference contouring 
and of subroutines EHDOT, KGAIN, and UPDAT for use in extended 
Kalman filtering. This section has presented the one through six 
degree of freedom studies of the identifiability chara.cteristics of 
several selected DSRV coefficients and parameters using the MAIN 
program of Appendix A19 and the DATA of Appendix A20, These studies 
have shovm that for the DSRV the most significant degree of freedom 
is roll and that the model reference contouring technique is valid 
for up through six degree of freedom motions of the DSRV. The next 
section presents a brief summary of this thesis and a description 
of several areas for further study. 
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SECTION 7 



SUMMARY AND CONCLUSION (s) 

51 THESIS SUMMARY AND CONCLUSIONS 

5 2 AREAS FDR FURTHER STUDY 



"NO PLEASURE IS COMPARABLE TO THE STANDING UPON THE VANTAGBGROUND 
OF TRUTH." FRAiNCIS BACON (156I - I626) 



THE TECHNIQUES OF MODEL REFERENCE CONTOURING AND EXTENDED KALMAN 
FILTERING ARE VAI.ID AND USEFUL FOR IDENTIFYING COEFFICIENTS AND 
PARAMETERS IN OCEAN VEHICLE NONLINEAR DYNAMIC MATHEMATICAL MODELS 
USING NOISY INPUT-OUTPUT DATA, 
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CHAPTER SI 



TOESIS SUMMARY AND CONCLUSIONS 

IHe studies and results of this thesis cUre most applicable to the 
general area of motion control of ocean vehicles. The ability to 
mathematically simulate or predict the behavior of ocean vehicles in 
response to their effectors is usually helpful and sometimes essential 
in designing or utilizing vehicle control systems. The use of a vehicle 
mathematical model permits the running of a mathematical version of the 
vehicle in a computer rather than running the real vehicle in vrater, 

A mathematical model for simulating the motion of an ocean vehicle 
consists of a set of differential equations, called the structure, and 
a set of undetermined variables, called parameters. The equation 
structure is usually developed by theoretical and experimental investi- 
gations using some of the basic principles of physics, mathematics, and 
ocean engineering. The parameters in the mathematical model are usually 
determined by observing the behavior of the vehicle, a physical model 
of the vehicle, or a mathematical model of the vehicle. The central 
purpose of this thesis is the development, presentation, D3RV utiliza- 
tion and analysis of techniques for the identification of parameters 
in an ocean vehicle dynamic mathematical model using noisy input-output 
data. The primary conclusion here is that the techniques of model 
reference contouring and extended Kalman filtering are valid and useful 
for accomplishing this identification in as many as six degrees of 
freedom. 

Model reference contouring is essentially a comparison technique 
to determine a "best" set of parameters for the mathematical model 
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Khich causes it to behave siniilar to the vehicle. As a general proce- 
dure, model reference identification runs the model, v/ith the same 
inputs as to the system, for a large number of different parameters; 
and then it selects the specific set of parameters v.’hich result in 
the model output vjhich is "closest" to the vehicle output. 

Extended Kalman filtering is a data processing technique vjhich 
uses known characteristics of the noise in the vehicle data to estimate 
the true (noiseless) behavior of the vehicle and its parameters through- 
out a maneuver, Kalman filtering is a linear technique with a firm 
theoretical foundation ’which, vrhen extended to nonlinear systems such 
as ocean vehicles, loses its theoretical foundation but sometimes 
works extremely vrell. 

Both of these identification techniques require mathematical 
models v.’hich are in "state space" form. This means that in order to 
use these techniques, the usual structure adopted for ocean vehicle 
dynamics must be converted to state space form. For these equations 
the state space format is simply a redefinition of the primary 
explicit variables as a set of ordered and indexed variables, b’ut this 
redefinition process greatly facilitates both the computation of the 
equations and the inclusion of such aspects of ocean vehicle behavior 
as fluidic memory states and higher order derivatives of the primary 
states. 

The studies of this thesis begin with the development of general 
state space models for the dynamic motions of ocean vehicles. Then the 
detailed equations for the two identification techniques are presented 
and their use is described in detail. Next, the vehicle equations and 
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the identification technique equations are coinliincd for in-depth studies 
of the DSRV single degree of freedom mathematical models, Ihen the com- 
plete 6 degree of freedom DSRV model, its gradient, and all of its 
computer programs are described and several selected coefficients and 
parameters are identified using 1, 2, 3, 4, 5, and 6 degree of freedom 
simulated sea trials, and the results are discussed and compared. 

Finally, all of the computer programs used are listed, and a bibliogra- 
phy of references from the areas of system identification and ocean 
vehicle dynamics is included. 

Several significant conclusions may be drawn from the single and 
multiple degree of freedom DSRV studies of this thesis. First of all, 
both model reference contouring and extended Kalman filtering are 
valid for the single degree of freedom models of the DSRV. For model 
reference contouring the best input function is found to be a sinusoida] 
function with a period near the "natural frequency" or "break point 
frequency" of the system; and detailed noise studies show that for the 
DSRV surge equation, 10^ process and 10^ measurement noises permit 
about 10;^ identification accuracy of the parameters. In addition, the 
shapes of the model reference contours show the identifiability char- 
acteristics of the parameters in addition to actually permitting their 
identification. 

Regarding the extended Kalman filtering technique, it has been 
found that it is much more difficult to "tune" the filter and that 
the integration technique must be more accurate than for model refer- 
ence contouring. However, once the filter is adjusted and given 
reasonably good initial estimates of the parameters, it is a far more 
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accurate identification technique in the presence of large (20;*^ or 
greater) amounts of noise than is the model reference contouring tech- 
nique. In addition, the extended Kalman filter in its general form 
may be used for the identification of many parameters at once, v;hereas 
the model reference contouring technique looks at the parameters two 
at a time. The multiple degree of freedom (DOF) extended Kalman 
filter presented in the computer programs of this thesis is incomplete, 
but the 1 DOF filter is shown to be valid for the six individual single 
degree of freedom DSRV equations. 

Finally, and most significantly, the model reference contouring 
technique is shown to be valid for selected parameters in 1 through 6 
degree of freedom DSRV mathematical models. In several cases, it is 
shown that 1 DOF parameter identifiability studies may be directly 
applied to those same parameters in '6 DOF for the same maneuver. 
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CHAn'HR S2 



ARSAS FOR FUHT H RR STUDY 

The fa.ct that the paxametric identification techniques of model 
reference contouring and extended Kalman filtering are valid and 
useful techniques for the evaluation of ocean vehicle model parameters 
opens up many possible areas for further study. Ibese areas are 
described here in somevfhat of a simplified "idea" format vrith refer- 
ences to the applicable sections of this thesis and to entries in the 
Bibliography in Chapter Bl. 

52.1 Develop and analyze general and specific measurement functions 
for ocean vehicles (Chapter H3.l). Study the parameters for their 
identif lability characteristics, especially in combination with the 
vehicle parameters, and perform measurement parameter identifica- 
tions from noisy sea trial data using the model reference or EKF 
techniques. 

52.2 Develop the general state space equations of motion for a vehicle 
with a time varying mass or with an accelerating center of gravity 
(Chapter Ml. 2). How do the identif lability characteristics of the 
parameters change? 

52.3 There exists a vrealth of data reduction techniques for finding 
parameters in ocean vehicle models, techniques vfhich have been used 
for many years in the field of Naval Architecture and Marine Engineer- 
ing. A comparison should be made of these techniques v/ith the tech- 
niques of Modern Control Theory to determine the advantages and 
limitations of each. (Chapter Nl.l) 
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S2»^i InstGcid. of using s. InyXor S63 ?ig 3 cxps-nsion of "tho hycijcoclyncLinic 
forces and moments in Chapter M2. 3, use a Fourier, Bessel, Hcrmite, 
or other type of expansion for the specification of this structure. 

Then make studies of the coefficient identifiability and determine 
the kinds of ocean vehicles best modeled by such expansions and the 
reasons vrhy, 

52.5 Develop the equations and study the coefficients required for 
some implicit solutions to equation M2. 24, V/hat para.meters are 
required, how identifiable are they, and how much better is the math- 
ematical model with them included? 

52.6 Relate the general theory of coefficient expansions of state 
space ocean vehicle mathematical models to the general theory of 
covariant and contravariant tensors (Chapter M2. 4). Develop general 
relationships for the numbers of n'th degree coefficients vrith and 
without symmetry. Develop general expressions for efficiently and 
rapidly addressing and storing n'th degree coefficients in computer 
programs (Equation Dl,l6 for example), 

52.7 Develop the equations for and study the identifiability of the 
parameters in "fluidic memory" mathematical models for specific ocean 
vehicles (Chapter M3. 2), Formulate simple examples to show the 
memory effects, and use single or double degree of freedom models 

to identify fluidic memory coefficients. Formulate general conditions 
and vehicle constraints vrhich may be used to reduce the numbers of 
fluidic memory coefficients. Set up and evaluate multiple degree of 
freedom fluidic memory models for specific ocean vehicles. The author 
Considers the incorporation of fluidic memory states and their associ- 
ated parameters and the incorporation of higher order dei'ivative states 
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and their associated parameters to be the two most potentially 
profitable areas for further studies using the techniques of this 
thesis, 

52.8 Study the feasibility, expense, and accuracy of using analog 
or hybrid computation and continuous parametric identification 
techniques for ocean vehicle mathematical models. This may or may 
not require decoupled models or a structure-selective multiple 
degree of freedom model, 

52.9 Can a list be made of most of the significant types of struc- 
ture (such as absolute square in Chapter M3c3) for a class of ocean 
vehicles (for example, surface ships)? If this is possible, then 
perhaps the identif lability characteristics of the parameters in 
each of these structural types may be determined separately using 
simple single degree of freedom models and combined in some manner 
to reveal the identifiability characteristics of more sophisticated 
models vfhich involve combinations of these significant types of 
structure, 

52.10 Investigate model reference contouring using different config- 
urations from that of Figure N2,l (see Astrom) (A-13)» 

52.11 There are some techniques in Modern Control Theory which are 
applicable to specific problems of parametric identification in 
distributed systems or partial differential equations. Investigate 
general partial differential equation ocean vehicle models, perhaps 
including continuous fluidic memory, and determine techniques 
applicable to identifying parameters and to determining their ident- 
ifiability characteristics. 
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52.12 One possible reduction of the General state-space models of 
Section 2 (h) which contains linear plus second dcGree coefficients 
is given by equation S2d. This equation may or may not behave like 
a specific ocean vehicle, but its nonlinear characteristics may 
relate to those of the general models (especially the second degree 
coefficients in A 2 ) for certain maneuvers. Study this equation in 
general using the results and techniques of Modern Control Theory. 

X = X A 2 X a + u -i- u u^ b + C X c S2.1 

V/here: x = state vector 

w = control vector 

a, b, £ = known weighting or non-diraensional- 
izing vectors 

A^, A 2 , B^, B 2 . C = system matrices containing 

parameters which must be 
identified 

Can a general state transition matrix be found for this equation? 

What are the conditions on the equation for there to be stability, 
observability, controllability, identifiability, invertability , etc,? 
How does the behavior of this equation correspond to known ocean 
vehicle behavior? l^hat is indicated by the fact that equation S2.1 
contains no absolute square lavf behavior? 

52.13 The effects of vehicle control systems have not been included 
in the models of Section 2 (m) (for example, equation M2, 32) or in 
the programming of Section 5(D). Investigate the effects on para- 
metric identifiability for specific ocean vehicles when the control 
is a linear function of the state given by equation S2.2 or a non- 



linear one given by equation S2.3« 
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u = -A. X ; K ~ control gain matrix S?»? 

u = -k (x) ; k = control function structure S2.3 

S2.1^ It is possible to include higher order derivatives of the 
states in the general mathematical models of Section 2 (h). V/ith 
these multiple derivatives (md) , included in the hydrodynamic 
structure, equation M2. 24 becomes equation S2.4. Now, if a new state 

( )" 

\k - 4yd i ) = 4(x) + s2.4 

vector Xjjid defined as in equation S2.5 to include the multiple 
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derivative terms 


, then 


equation S2. 


4 may 



S2.5 



multiple derivative state vector as in equation S2.6, The forms 



\d ^d " 4id,hyd ^^d' ^d^ 4id ^^d^ 4id,eff ^^d’ ^d’ 



S2.6 



for the matrix A 
and S2.8, 



md 



and the vector f , are given in equations S2.7 




S2.7 
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.n / nH-I 

r = 2^ (2S* X, •••, , k^, f^, S2.9 

Equation S2,6 is somewhat misleading in that it does not 
directly display the n-th oi’der differential equation behavior in 
the original equation S2,4, One way of directly showing this 
behavior is to assume that 2^^^ in equation S2.4 can be solved for 
the highest state vector derivative by the function as in equa- 
tion S2,9t In this case, the general mathematical model could be 
written as the first order vector differential equation S2.10. *The 
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VJhere: I = Identity Matrix S2.10 



multiple derivative state vector used here can also be redefined 
to include the fluidic memory states of Chapter M3. 2 and their 
multiple derivates, with the appropriate modifications to X^^. 

Can a set of criteria be developed which vrill tell when the 
mathematical model for an ocean vehicle should include fluidic memory 
states or multiple derivative states? (See also Chapter S2,?) It 
is expected that, as in the case of fluidic memory, the multiple 
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der.i.vatives need not apply for many derivatives or for more than a 
few degrees of freedom. Therefoi'e, simple models may be developed 
which include the basic effects of multiple derivatives and v.'hich 
contain multiple derivative coefficients and parameters which may 
be identified using the techniques of this thesis, 

52.15 The gravity forces presented and discussed in Chapter HI. 3 

were included in the general category of effector forces. These 
gravity forces are functions of the vehicle orientation angles 
(</', 0, 'if) w'hich axe in turn functions (integrals) of the primary 
vehicle velocities (states). In the later state space models of 
Chapter M2 these angles do not appear directly (They do appear 
directly in the model of Section 5(D) and in the computer programs.) 
but rather appear implicitly as an effector in with its own 

state variables whose input-output behavior is all that appears in 
the model. This has the effect of making a nine state variable (u v 
w p q r 0 ^5^) problem appear as a six state variable (u v w p q r) 
problem. 

Formulate the state space relationships for the direct inclusion 
of the integrals of the primary velocities /x dt in the general mathe- 
matical models of Section 2(M)a Investigate the parameters required 
and their identifiability characteristics, 

52.16 Complete the extended Kalman filtering programming for Section 
6(C), This will require a subroutine of the form of the MAIN program 
of Appendix Al4 but somewhat larger and able to manipulate the general 
subroutines of Appendix A18, These subroutines represent, respec- 
tively, the general versions of subroutines PROP, GAIN, and UPDAT of 
Appendix A14, An output subroutine to plot the outputs of the desired 
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states, parameters, and error covariances v.’ould also have to be 
written. The result of this programming viould be an extended Kalman 
filter capable of identifying (estimating) up to 200 parameters at 
once for a general nonlinear ocean vehicle of the form of subroutines 
OVMOD and OVDSR described in Section 5(D). 

S2.17 Investigate the use of a time-sharing digital computation 
program with the model reference configuration to allow an operator 
at a typevrriter to "visualise" the behavior in C (£) of more than 
two parameters at once. The opei'ator could start with the initial 
vedues of the parameters, make variations in those directions v;hich 
reduced C (£) , and thereby "learn" the shapes of n-dimensionad contours 
and the identif lability characteristics of many pai'ameters at once, (S-6) 
S2tl8 The 6*6 model reference contouring program of Section 6(C) is 
so flexible and general that the author's studies of the D3HV did not 
even begin to exhaust the wealth of behavioral and parametx'ic studies 
which could be conducted on the DSRV model using these programs 
directly as written. Someone interested in further studying these 
aspects of the DSRV could use this "tool" very effectively and bene- 
ficially, 

52.19 By changing only the input data and the characteristics of 
OVMOD, another ocean vehicle could be included in the 6*6 model 
reference contouring program of Section 6(C), This vehicle could 
then have the identifiability characteristics of its parameters 
studied in pairs as was done for the DSRV, 

52.20 For a specific and sophisticated ocean vehicle vrhich I'equires 
extremely precise control, perhaps the "model v;ithin the ship" idea 
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of Chapter 13 could be applied. V.'hat predictive capabiljtioc are 
required for a specified precision of control? V.'hat kind of input- 
output data and what size computation facility must be on-board to 
permit tlie self-identification of the vehicle? What kinds of behavioral 
cost functions must be specified for the vehicle to complete its 
missions? 

52.21 Investigate tb.e use of the Fade approximation technique (C-14, 

8 - 103 ) for modeling fluidic memory in state space ocean vehicle models. 

52.22 One identification technique which offers potential for application 
to ocean vehicle mathematical models is the "maximum likelihood estima- 
tion" technique (S-6) (R-7) (K-14) (J-5) (I~3) (I-4) (G-6) (C-3) (A-13). 
This technique has more general applicability than either model reference 
contoiuring or extended Kalman filtering and combines several, aspects of 
both of these techniques. Investigate the use of the maximum likelihood 
technique for simple or complex ocean vehicle models with different 
combinations and configurations of system noises, 

32.23 Investigate the theoretical a.nd practical considerations which 
lead to the application of single DOF identifiability results to selected 
multiple DOF models and to the application of dual parameter identifi- 
ability results to the multiple parameter models and identifiability 
studies. 
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SBiCTION 8 



apfendicss (a) 

A1 NUMERICAL VALUES OF DSRV PARAMETERS AND COEFFICIENTS 

DSRV COEFFICIENT FUNCTIONS AMD SELECTION CONSTANTS 

A3 secondary drag EQUATIONS 

A4 IBM/SSP subroutines used in THIS THESIS 

A5 contouring AND PLOTTING SUBROUTINES 

A 6 CHAPTER D2 SUBROUTINES (OVMOD) 

A7 CHAPI'iffi D3 SUBROUTINES (EFFECTORS) 

A 8 CHJ^FTSR D5 SUBROUTINES (OVDER, GRADIENT) 

A9 CHAPTER D 6 SUBROUTINES (EFFECTOR GRADIENT) 

AlO THE MEAN OF A SQUARED GAUSSIAN RANDOM VARIABLE 

All A NONLIN15AR OBSERVABILITY CRITERION APPLIED TO THE DSRV SINGLE 
DEGREE OF FRESD'OM EQUATION 

A12 CHAPTER P3 MODEL REFKRENCS SINGLE DEGREE OF FREEDOM PROGRAM 
AND SUBROUTINES 

AI 3 MODEL REFERENCE STUDIES OF A LINEAR SURGE EQUATION 

A14 CHAPTER P4 EXTENDED KALMAN FILTER SINGLE DEGREE OF FREEDOM 
PROGRAM AL’D SUBROUTINES 

AI 5 PUTTING A "WHAMMY" ON NEGATIVE E IN EXTENDED KALMAN FILTERING 
AI 6 SUBROUTINES PROP AND RKNL WITH RUNGE-KUTTA INTEGRATION 
AI 7 SUBROUTINES USED IN 6 * 6 MODEL REFERENCE CONTOURING 
A18 SUBROUTINES USED IN 6 * 6 EXTENDED KALMAN FILTERING 
AI 9 MAIN 6*6 IDENTIFICATION PROGRAM STATEMENTS IN FORTRAN IV (MAIN) 
A20 SAMPLE DSRV INPUT DATA DE'CK FOR APPENDIX AJ.9 
"ROUND NUMBERS ARE AIRWAYS FALSE." SAMUEL JOHNSON (1709-1784) 

THIS SECTION CONTAINS THE FORTRAN IV COMPUTER PROGRAMS DEVELOPED FOR 
AND USED THROUGHOUT THIS THESIS. IN ADDITION, SEVERAL EXTENSIONS OF 
AND DEVELOPMENTS FOR THE RESULTS OF EARLIER SECTIONS ARB INCLUDED. 
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APPENDIX A1 



NUMERICAL VALUES OF DSRV PARAMETERS AND COEFKICIENT S 

Ihe DSRV states and coefficients aore contained in the augmented 
state vector X(258), 

X(l) - X(6) = Primary states 

X(?) “ X(l32) =5 Second-degree coefficients 

X(l33) •” X(258) = Reverse-mode second-degree coefficients 

The DSRV parameters are contained in the parameter vector P(58?). 

P(l) - P(3^) " Added mass terms X^ to in the order of 

X^ located at j + 6(i - l) 

P(3?) " P(42) = Cross products of inertia I located at 

i^i 

i + 36 

P(43) = DSRV reverse mode region determination constant 

P(44) - P(?l) « Tanks parameters; 44-50 = equilibrium loadings 

of 7 tanks, 51 "57 = x-locations of 7 tanks, 
58-64 = y-locations of 7 -tanks, 65-71, z-loca- 
tions of 7 tariks 

P(72) - P(l02) = Secondarj’- drag parameters; 72-99 = C^y 

C^y Cf^, i = 1, 7 in groups of ?, P(lOO) = L^, 
P(lOl) = L^, P(102) « •* L^ 

P(l03) - P(228) - Shroud parameters 

103 - 118 Lift parameters; IO 3 -IO 8 » ranges, 109-113 = 
lift slopes, 114-118 = lift intercepts 
119 - 149 = Drag parameters; 119-129 = ranges, 130-139 => 
drag slopes, 140-149 = drag Intercepts 

150 « Xg, shroud location 

151 “ ^r' area 
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228 

265) 

559) 

290 

315 

325 

341 

363 

385 

391 

394 

428 

456 

472 

500 

531 

559 



” specific gravity of >;ater 
= EPS or 0‘^ for SHCAL 
« Ovorflo’j indicator for SHCAL 
= Lift derivative parameters; 155-164 =. ranges, 
165-173 “ lift derivative slopes, 174-182 
lift derivative intercepts 
= Drag derivative parameters; 183-1 98 = ranges, 
199-213 = drag derivative slopes, 214-228 ^ 
drag derive-tive intercepts 
= Propeller Parameters 
= Ihruster Parameters 

f 

= ranges, slopes, intercepts, (8) 
t= ranges, slopes, intercepts, (8) 

= ranges, slopes, intercepts (3) 

= ranges, slopes, intei'cepts (5) 

= M* ranges, slopes, intercepts, (7) 

« M* ranges, slopes, intercepts, (7) 

= rnruster coefficients 
t= Ihruster EPS or O'^ 

= Maximum ranges for + u/|nl 

=: DT^ ranges, slopes, intercepts, (ll) 

== DT2 ranges, slopes, intercepts, (9) 

« DT^ ranges, slopes, intercepts, (5) 

= DT^ ranges, slopes, intercepts, (9) 

=> DM* ranges, slopes, intercepts, (lO) 

= DM2 ranges, slopes, intercepts, (9) 
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P(560) - P(5?l) “ Noise means (6) ajid variances (6) 

P(573) ~ P(5??j ^ ConstcUit forces and luomonts 

P(5?8) - P(585) « Vai'iable pctrameters, V/, xq, yq, 7 ,^, B, 

X3, 

P(586) - P(58?) = Constants; DSRV mass ajid acceleration of 

gravity, G 

liie following psiges list these states, coefficients, and param- 
eters as vised in the DSRV simulations and identifications in this 
thesis. Ihe start values are designed to place a ± 50 ^ region around 
the central value of the state, coefficient, or parameter. The 
increments are set for producing this + 50 ^ region by using the 

I 

start value and 46 increments for a total of 4? specific values with 
the true value at location 24, 
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  P(559)  =  Thruster  Parameters 

266  -  290  =  T*  ranges,  slopes,  intercepts,  (8) 
291  -  315  ■"  lp  ranSesi  slopes,  intercepts,  (8) 
316  -  325  ■  To  ranges,  slopes,  intercepts  (3) 
326  -  3^-1  =  Til*  ranges,  slopes,  intercepts  (5) 
342  -  363  ■  M*  ranges,  slopes,  intercepts,  (7) 
364  -  385  -  M*.  ranges,  slopes,  intercepts,  (7) 
386  -  391  =  Thruster  coefficients 

392  -  Thruster  EPS  or  0+ 

393  -  394  ■  Maximum  ranges  for  +  u/|n| 

395  -  428  ■  DT*  ranges,  slopes,  intercepts,  (ll) 
429  -  456  o  DT^  ranges,  slopes,  intercepts,  (9) 
457  -  472  ■  DT3  ranges,  slopes,  intercepts,  (5) 
473  -  500  ■  LTJt  ranges,  slopes,  intercepts,  (9) 
501  -  531  -  DM*  ranges,  slopes,  intercepts,  (10) 
532  -  559  -  DM|  ranges,  slopes,  intercepts,  (9) 
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p(560)  -  P(57l)  -  Noise  means  (6)  and  variances  (6) 

P(573)  -  P(577)  -  Constant  forces  and  momenta 

P(578)  -  P(535)  ■  Variable  parameters,  W,  Xq,  yG,  z_,  B, 

xB,  yB,  eB 

P(586)  -  P(5S7)  -  Constants;  DSRV  mass  and  acceleration  of 

gravity,  G 

The  following  pages  list  these  states,  coefficients,  and  param- 
eters as  used  in  the  DSRV  simulations  and  identifications  in  this 
thesis.  The  start  values  are  designed  to  place  a  +  50/2  region  around 
the  central  value  of  the  state,  coefficient,  or  parameter.   The 
increments  are  set  for  producing  this  +  50%   region  by  using  the 
start  value  and  hG   increments  for  a  total  of  47  specific  values  with 
the  true  value  at  location  2k, 
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*  KIJ    >    UK   *    X=STATE    VECTOR*    XS-5TART    VALUE-.:    XINOI NCREMEN1 

*  151    *    145   *  0,0000    *  0,0000    •  0-0000    4 

*  152    S.    146    *  0,0000    *  0,0000   *  OoOOOO    * 

*  153    *    147    *  OoOOOO  OoOOOO   *  OoOOOO    * 

*  154    *    14G  0.0000  0,0000   *  OoOOOO   * 

*  155    f    149   *  -241*0000                   -361,5000   *  4o8200    - 

*  156    *    150    *  OoOOOO    *  OoOOOO  OoOOOO    * 

*  157    *    151    *  OoOOOO    *  OoCOOO   *  OoOOOO   >' 

*  153    *    152    *  0o0000  OoOOOO    *  0-0000   * 

*  159    *    153    i  OoOOOO  0,0000  0-0000    * 

*  160    *    154   *  642o0000  32U0OOO    *  12o3400 

*  161    *    155    *  OoOOOO    *  OoOOOO   *  OoOOOO    4 

*  162    *    156    -.  0,0000    *  0,0000   *  OoOOOO   4 

*  163  :•  157  ••:  OoOOOO  OoOOOO  *  0,0000  * 
9  16  4  *  15  8  *  OoOOOO  OoOOOO  0.0000  4 
«    165     ■■    159    *  OoOOOO   '  0,0000  OoOOOO   4 

*  166    *    160   *  0,0000    *  OoOOOO    *  0,0000    * 

*  16  7  *  161  *  0,0000  •;-•  0,0000  0.0000  ■■■ 

I    168   *    162   *  OoOOOO  OoOOOO  OoOOOO    - 

*  169    :-    163   *  9240o0000   *              462  0,0000  184o8000    i 

*  170     ■■    i64    =•  0,0000    *  0,0000   *  OoOOOO   * 

*  171    *    165    *  OoOOOO    *  OoOOOO    •  OoOOOO    * 

*  172  *  166  *  OoOOOO  OoOOOO  n  OoOOOO  * 
I    173    *    167   *  OoOOOO    *  OoCOOO    4  OoOOOO   • 

*  174   *    168   *  OoOOOO    *  0,000  0  0,0000    - 

*  17  5    *    169    *  -2o4300  -3,6450   *  0*0486    * 

*  176    ;-    170    *  0,0000  OoOOOO  OoOOOO    1 

*  177    *    171    ■•■  OoCOOC     :  0,0000   *  OoOOOO    4 

*  178    K    172    *  -156,0000                   -2J7>0000   :  3,1600    ■ 
=*    179    *    173    4  OoOOOO    *  OoOOOO    *  OoOOOO    * 

*  130    *    174    *  0,0000  0,0000  0,0000    * 

*  131    *    175    *  0,0000  0,0000    >  0,0000   • 
J    132    *    176    -•  0,0000    *  0,000  0    *  OoOOOO   4\ 

*  133    *    177    ::  OoOOOO    *  0,0000  0,0000    ^: 

*  134    *    173   *  0,0000    *  0,0000   *  OoOOOO    1 

*  155    *    179   *         -10400c 0000     :         -15600^0000  208o0000    1 

*  136    *    130    *  0,0000    *  0,0000  0,0000    i 

*  187    *    181    *  OoOOOO    *  OoOOOO  OoOOOO    - 

*  188    f    182    *  OoOOOO    *  0,0000    1  0.0000    • 

*  139     •    133    *  OoOOOO     -  0,0000    *  0,0000    - 

*  HO     -■    184   *  OoOOOO  0,0000  OoOOOO    * 

*  191    *    185    *  0,0000    *  0,0000   *  0,0000    N 

*  192    f    186    *  0,0000    *  OoOOOO   *  OcOOOO    • 

*  193    *    187   *  OoOOOO   *  OoOOOO   *  OoOOOO    4 

*  194    *    188    *  0,0000  0,0000   *  OoOOOO    • 

*  195    H    189    *  OoOOOO  OoOOOO   *  OoOOOO    * 

*  196    H    190    *  OoOOOO   *  OoOOOO    4  0,0000    * 

*  197     *    191    *  642o0000   *  32 lo 000  0   *  12Q 8400    ■ 

*  198    *    192   *  OoOOOO    *  OoOOOO  OoOOOO    : 

*  199     *    193    *  OoOOOO     »:  0,0000  0,0000    * 

*  200    *    194   *  OoOOOO  0,0000   *  OoOOOO    4 

♦*$  i'.i-V^v*.:-;""-:' :*:     i       I      ■.'.-.■■ 
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*  KIJ   ■*    UK   *    X=STATE    VECTOR*    XS-START    VALUED     XINOINCRi 

I    201     •    19  5    *  OaOOOO    *  0,0000  OoOOOO    * 

*  202  '•  196  *  -3670,0000  -5505,0000  *  73,4000  > 
4    203    *    197    *  Oc-0000  OoOOOO  0,0000    i 

*  204     N    198    *  OoOOOO  C,0000  OoOOOO    * 

*  205    *    199    *  OoOOOO    *  OoOOOO    *  OoOOOO    * 

*  206    *    200    -v  OoOOOO  OoOOOO  OoOOOO 

*  207    *    201    *  OoOOOO    *  0,0000   *  OoOOOO   1 

*  208    *    202    *  OoOOOO    *  OoOOOO    *  OoOOOO    >• 

*  209     i-    203    ■:■  OoOOOO  OoOOOO    .  0,0000    * 

*  2iO    >;    2  04   *  OoOOOO  0  ,  0000    *  OoOOOO    ■' 

*  211    *    205    v  -4290o0000    *  ~6435o0000   *  85,8000    • 

*  2i2    *    206    *  OoOOOO    *  0,0000  OoOOOO 

*  213     *    2C7    *  OoOOOO    *  OoOOOO  OoOOOO    - 

*  214  r-  208  *  OoOOOO  *  0,0000  OOOOOO  : 
v  2i5  *  209  ••  OoOOOO  *  OoCOOO  *  OoOOOO  * 
4  216  *  210  -:-  OoOOOO  OoOOOO  OoOOOO  1 
4    217     •<    211    *  -660OOOO     :■  -9  9o000  0  *  1,32  00    > 

*  218    ■•    212    *  OoOOOO  OoOOOO    *  OoOOOO    * 

*  219     .••    213    *  OoOOOO  OoOOOO  0U0000    • 

*  220     '•    214    *  -3000,0000    *  -450C, COOO   *  6O0OOOO    • 

*  221    *    215    *  OoOOOO   *  OoOOOO   *  OoOOOO    * 

*  222    *    216    *  OoOOOO  Co  0000    i  0,0000    * 

*  223    X    217    *  OoOOOO  OoOOOO   :  0,0000  * 

*  224    *    218    *  OoOOOO    *  OoOOOO  OoOOOO    * 

*  215    ■•    219    *  OoOOOO    *  OoOOOO  OOOOOO    •- 

*  226     >    220    *  OoOOOO    ••  OoOOOO  OoOOOO 

4    HI    *    221    *         -32000o0000    *          -43000oC000  639o9998    i 

*  228     *    222    *  OOOOOO  OoOOOO    i  0,0000    * 

*  229  ¥  223  *  0=0000  OoOOOO  *  OoOOOO  * 
4  230  -;  224  *  OoOOOC  OoOOOO  *  OoOOOO  * 
I    231     *    22  5    *  OoOOOO    *  OoCOOO    *  OoOOOO    < 

*  2  32    *    22  6   *  OoOOOO    *  OoOOOO  OoOOOO    * 

*  233    1«    227    *  0,OOOC    "  0,0000  0,0000    • 

*  234  *  228  *  OoOOOO  0,0000  OoOOOO  * 
4    lib    *    22  9   *  OoOOOO  OoOOOO   :-  OoOOOO    -• 

*  236     *    230    *  0,0000     ■  0,0000   *:  OoOOOO    * 

*  2  37  ••  231  *  OoOOOO  *  OoOOOO  *  OoOOOO  •' 
4  2  38  *  232  *  0,0000  *  0,0000  0C0000  * 
4    2  39    *    233    *  2880o0000   *  1440oC000  57o 6000    • 

*  240    ;;    234    *  OoOOOO     •  OoOOOO    *  OoOOOO    i 

*  241    i;    22  5    *  0.0000  0,0000   *  0,0000    • 

*  242    *    236   *  OoOOOO     -:  0,0000    *  OoOOOO    * 


a 


243    *    237   *  OoOOOO  0,0000  *                       OoOOOO  * 

*  244    *    238    *  -4290o0000  -6435,0000  *                   85o8000 

*  2^5    ¥    239    *  OoOOOO  '■                        OoOOOO  *                       0,0000  •> 

*  246    *    240    *  0,0000  *                       0,0000                            0,0000  i 

*  247     *    241    *  OoOOOO  OoOOOO                           OoOOOO  * 

*  248    :<    242    *  OoOOOO  *                      OoOOOO  *                      0,0000  * 

*  2h9     *    243    *  0,0000  *                       0,0000  *                       OoOOOO  i 

*  250    N    244    *  OoOOOO  :                       0,0000                            0,0000  * 
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*  KIJ    -:    UK   ••  X=STATE    VECTOR*  XS=STA.U    VALUE*    XINOINCREMENT* 

4    251    *    245   *  OoOOOO    *  OoOOOO   :  0^0000  1 

*  252     •:    246    -  0,0000    *  0o0000    *  OoOOOO  1 

*  253     •    247   *  -49700o0000  -74550oOOOO  993u 9996  > 
4    254    ,{    248    *  0,0000  0.0000  03 OOOU  : 

*  255    *    249  OoOOOO  OoOOOO  OoOOOO  :: 

*  256    :;    250   >'■■■  OoOOOO   *  OoOOOO   *  0,0000  * 
4    257    *    251    *  OoOOOO  OoOOOO  OoOOOO  •■ 

*  2  58   *    2  52    *■  OoOOOO    *  OoOOOO    *  OoOOOO  • 
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********  ,       ..      :. 

-375- 


> 

■: 
* 

* 

* 

i 

-; 
4 
4 

V 
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* 

i 
* 

4 

4 

»:■ 
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.     • 

■' :»J  ■• 
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1 

. 

■ 

KIJ 

'.■ 

P- PAR AM    VECTOR* 

PS=START    VALUE 

PINOINCREMENT4 

♦ 

1 

4 

-144o0000    * 

-21 60  000  0   v 

2o8800    *r 

3 

2 

4 

OoOOOO    * 

OoOOOO    4 

Oo  0000    :: 

* 

3 

* 

OoOOOO    * 

OoOOOO    4 

OoOOOO    4 

4 

4 

* 

OoOOOO    * 

OoOOOO        ': 

OoOOOO    4 

* 

5 

: 

OoOOOO    * 

OoOOOO    4 

Oo  0000    4 

* 

6 

* 

OoOOOO    * 

OoOOOO    * 

OoOOOO    > 

4 

7 

* 

OoOOOO    * 

Oo  000  0   4 

OoOOOO    4 

* 

8 

* 

-4 3 2 OoOOOO    * 

-6480,0000    -: 

86o4000    4 

¥ 

9 

4; 

OoOOOO    4 

OoOOOO    4 

OoOOOO    - 

4 

10 

-£ 

793^0000    4 

396,  5000    4 

15o66C( 

* 

11 

4* 

OoOOOO     ■ 

OoOOOO     ■ 

OoOOOO    4 

$ 

12 

4* 

8300o0000    4 

4150o0000 

166; 0000    4 

* 

13 

*i. 

OoOOOO 

OoOOOO    * 

OoOOOO   - 

* 

14 

♦ 

OoOOOO    4 

OoOOOO    4 

OoOOOO    4 

* 

15 

jj; 

-3600;;  0000    * 

-5400>  0000   4 

72o0000 

* 

16 

V 

OoOOOO  4 

OoOOOO    * 

OoOOOO    •: 

* 

17 

♦ 

-770o0000  * 

-1155o0000 

15o4000    i 

* 

18 

4 

OoOOOO 

OoOOOO     - 

Oo  0000    : 

* 

19 

* 

OoOOOO    - 

OoOOOO    4 

OoOOOO    4 

* 

20 

♦ 

917o0000    • 

4 5 80 500  0    v 

1 80  3400    ■• 

4 

21 

A 

OcOOOO    4s 

OoOOOO    4 

OoOOOO    : 

* 

22 

* 

-4530o  0000   * 

-5 795 0 0000    4 

90o6000    4 

4 

23 

* 

OoOOOO    * 

Oo  000  0   4 

OoOOOO    * 

* 

24 

* 

OoOOOO    4 

OoOOOO    • 

OoOOOO    4 

4 

25 

4i 

OoOOOO   4 

OoOOOO    4 

OoOOOO    - 

4 

26 

4* 

OoOOOO    * 

Oe  000  0    4 

0, 0000    • 

4 

27 

* 

-770o0000 

-115  5o000  0   4 

15o4000    : 

• 

28 

-A- 

OoOOOO    * 

OoOOOO   • 

0;0000       ' 

4 

29 

:£ 

-410000o0000    :; 

-6I5OOO0  000  0   4 

81990  9960    1 

* 

30 

4 

OoOOOO 

OoOOOO    4 

OoOOOO    : 

* 

31 

4* 

OoOOOO    * 

OoCOOO   : 

OoOOOO    4 

* 

32 

4 

830o0000    * 

415o0000    4 

I606OOO    ■ 

4 

33 

♦ 

OoOOOO    * 

OoOOOO   4 

OoOOOO    •■ 

* 

34 

$ 

OoOOOO 

OoOOOO 

OoOOOO    • 

4 

35 

*<- 

OoOOOO  4 

OoOOOO    4 

OoOOOO    •• 

* 

36 

*;• 

-4).0000o  0000 

-615000o0000    4 

8199o9960 

•V 

37 

jk 

37800o0000    * 

18900o0000 

755o  9998    * 

* 

38 

♦ 

OoOOOO 

OoOOOO     • 

OoOOOO    4 

* 

39 

:. 

452000.0000    * 

226000oC000    ■■'■ 

9039,9960    * 

4 

40 

4i 

OoOOOO    * 

OoOOOO 

OoOOOO    : 

4 

41 

* 

OoOOOO    * 

OoOOOO    : 

OoOOOO    4 

4 

42 

>p 

450000o0000  41 

225000oC000   4 

69S9o  9960    " 

* 

43 

* 

0ol730  * 

0o0865    * 

Oo0035    • 

* 

44 

* 

2404o0000   * 

1202:,  0000 

48o0800 

4 

45 

* 

93o0000 

46o500  0    •' 

I086OO 

4 

46 

4* 

93o0000    * 

46 0 500  0    4 

I086OO    4 

4 

47 

♦ 

210oOOOO   * 

10  5,000  0   * 

4o2  000    4 

4 

48 

4 

2l0o0000    * 

105o0000   * 

4o2000    >s 

4 

49 

* 

200o0000    4 

iOOoOOOO    • 

4o0000    • 

* 

50 

* 

200o0000    * 

lOOoOOOO   : 

4o0000    • 

1     ■ 

1  '■  '■'.". 

.-■.■■.'■  ''    '■:■  :'-.'■'.  44  44           : 

:44»!     .    .:  ■'■'■■-    ' 

■ 
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j     :     *:'■  *  '■'■    ■-.'■:--:::'.  <M  ******      -.::•'- 

■/  t    i  «:•      r>  —  n  .«.  o  am     w  c  r  t  n  •>    •      or.,  r  -r  »  -.  t-      >,••    in-... 
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1 

KIJ 

*    P 

=PARAM   VECTOR*    PS' 

'START    VALUE 

* 

51 

* 

-30  3700 

-5o0550    • 

* 

52 

* 

~3o3700    * 

-5o0550 

* 

53 

A 

-3o3700 

-5,0550    •' 

4 

54 

?.. 

18o9000 

9oA500   * 

* 

55 

;.;: 

-18o4000     •' 

-27o6000 

* 

56 

& 

12o7500    * 

6o3750   * 

* 

57 

-12o3000    * 

-18o4500 

* 

58 

ft 

OoOOOO    * 

OoOOOO    * 

* 

59 

•v 

2o2100    ■ 

lolOSO   * 

* 

60 

i 

-2o2100    * 

-3o3150    * 

* 

61 

* 

OoOOOO 

OoOOOO    * 

* 

62 

* 

OoOOOO    * 

OoOooo  * 

63 

* 

OoOOOO    * 

OoOOOO    '• 

* 

64 

* 

OoOOOO    * 

0 , 000  0    * 

* 

65 

♦ 

3o 0800    * 

io  5400   * 

* 

66 

$ 

-2o2100    * 

-3o3150 

* 

67 

* 

-2o2100    * 

-3o3i50   * 

* 

68 

* 

-2o8400    * 

-4o2600    * 

* 

69 

* 

-2c 5000    * 

-3o7500    * 

* 

70 

♦ 

-2G4600   * 

-3o6900 

* 

71 

* 

-2o2  80  0    * 

-3o4200 

* 

72 

je< 

loOOOO    * 

0o500  0    1 

* 

73 

* 

-0ol500    * 

-0o2250     ■ 

¥ 

74 

* 

183o6975    * 

91»8487   * 

* 

7  5 
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♦ 

0.7500    * 

0.3750 

* 

0.0150    - 

* 

541 

* 

loOOOO    * 

Co  5000 

.1 : 

0o0200    * 

4 

542 

* 

OoOOOO    # 

OoOOOO 

' 

OoOOOO    - 

* 

543 

V- 

-645.0000    ■'■■ 

-967.5000 

V 

12o9000    * 

* 

544 

♦ 

OoOOOO    * 

Oo  0000 

v 

OoOOOO    5 

* 

545 

•  r* 

1443o2150    * 

724.1074 

•  ■ 

28.9643    • 

¥ 

546 

* 

OoOOOO    * 

OoOOOO 

•./ 

OoOOOO   >. 

4 

547 

* 

-1531.4290    * 

-2297.1440 

. 

30.6286 

V 

548 

si'- 

OoOOOO    * 

OoOOOO 

* 

OoOOOO    * 

k 

549 

* 

993.  3333   * 

49fe06665 

?■ 

1908667    * 

4 

550 

* 

OoOOOO    * 

OoOOOO 

* 

OoOOOO   - 

i 

,  ?S  •i::i!^5  v 

.    :      .                                ... 

:     ■ 

:                      i 
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•  -■- 

■.-.- 

■ 

":  '  ■'■■' 

. 

' 

$ 

KIJ 

. 

P=PARAM    VECTOR* 

PS- START    VALU: 

1  1  IOINCREMEN1 

551 

| 

-8.0000 

•' 

-12.0000 

:'t 

0, 1600    " 

•': 

55? 

$ 

-362.7500 

ft 

-544.1250 

-. 

7o?r>50     ' 

553 

A, 

-72.5000 

-108.7500 

1*4500 

*, 

554 

'' 

-0.0867 

;■• 

-0.1301 

0*0017     K 

555 

<' 

217*1430 

fc 

1083  5715 

.: 

4,342  9     ■ 

*: 

556 

k 

829.7151 

4- 

414*8574 

'. 

16.5943 

':■ 

557 

. 

64.  0000 

*» 

3?o0000 

'. 

1,2800    * 

t 

558 

•'' 

-581.6670 

-87?o  5005 

■ 

11. 63  3? 

«7 

559 

jt. 

163„ 3333 

81«,6666 

■'? 

3*  2  6  67     •• 

Ti 

560 

:•• 

Oo  0000 

■■■ 

0,  0000 

a. 

OoOOOO 

•; 

561 

* 

OoOOOO 

' 

OoOOOO 

0:000  0       ■ 

fc 

56? 

. 

0,0000 

- 

OoOOOO 

0*0000     1 

ft 

563 

OoOOOO 

■ 

OoOOOO 

4j 

OoOOOO    * 

.-•; 

564 

*\ 

0..0000 

' 

OoOOOO 

* 

OoOOOO    ' 

& 

565 

f 

O3  0000 

' 

0:>  0000 

'■ 

OoOOOO     -: 

& 

566 

* 

?o0000 

is 

loCOOO 

':■ 

O0O400   :■ 

* 

567 

-.'"' 

2o0000 

jji 

loOOOO 

■ 

0o0400     - 

it 

568 

«- 

2.0000 

- 

loOOOO 

'■ 

0o0400     ' 

• 

569 

fc 

50c0000 

• 

25.o  0000 

••; 

loOOOO     - 

- 

570 

I> 

50o  0000 

■; 

25^0000 

' 

UOOOO    - 

.:- 

571 

\ 

50.0000 

^ 

25,0000 

1,0000    < 

?: 

57? 

.- 

0.0000 

* 

0,0000 

.1: 

0,.  0000    > 

£ 

573 

r> 

0,0000 

dp 

r 

OoOOOO 

* 

OoOOOO    * 

ft 

574 

.;•■ 

OoOOOO 

* 

OoOOOO 

* 

0=0000 

?'• 

575 

% 

OoOOOO 

-'■ 

OoOOOO 

■'. 

OoOOOO    1 

•■: 

576 

■- 

OaOOOO 

'r- 

0,  0000 

.' 

OcOOOO     • 

*; 

577 

j- 

0,0000 

'■ 

OoOOOO 

' 

0,0000     ' 

*< 

578 

■ 

140369-.0000 

70184,5000 

2807c 3790     * 

fc 

579 

* 

OoOOOO 

.[: 

Oo  0000 

'; 

OoOOOO     ' 

' 

580 

5 

OoOOOO 

■': 

OoOOOO 

• 

OoOOOO    * 

581 

> 

0,  133  5 

4, 

0,0667 

0,0027    * 

| 

58? 

% 

140369,0000 

'. 

70184*5000 

' 

2807,3790    ' 

* 

583 

i* 

OoOOOO 

'• 

OoOOOO 

ft 

OOOOOO    * 

■>> 

584 

| 

Oo  0000 

k 

0*0000 

' 

0,0000     • 

j«, 

585 

OoOOOO 

* 

OoOOOO 

: 

OoOOOO    -: 

$t 

586 

J. 

4  3  63-,  00  00 

' 

2181.5000 

87c?600     ' 

* 
U 
ft 
ft 

* 

587 

( 

3?o  1726 

-r 

16, 0363 

- 

0*64  3  5    ► 

* 

• 

* 

* 

* 

...... 
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APPENDIX  A2 

DSRV  COEFFICIENT  FUNCTIONS  AND  SELECTION  CONSTANTS 

The  CSRV  mode],  uses  59  of  the  possible  126  second-degree  coeffi- 
cients.    Of  those  59,    33  are  functions  calculated  by  XFUNS,   24  are 
constants,   some  of  which  have  regional  peculiarities,   and  2  are 
functions  calculated  by  SECAL. 

Trie  functions  and  constants  aro  selected  in  XFUNS  using  the 
vector  (listed  across  page)   XF*      Absolute  values  are  selected  in 
XDCAL  using  the  vector  AV.      The  coefficient  functions  may  be  deter- 
mined by  looking  at  the  corresponding  branch  of  the  initial  conditional 
GO  TO  statement  in  subroutine  XFUNS  based  upon  the  value  of  XF  of  the 
desired  index. 

XF(126)  =  35       00000000000       12 

0      6      0    35      0      0    36      0    35 

0       9      0     10      0       0       0     II     12 

0       0     13       0     14     15       0       0       0 

0    34      0    17    18      0      0    35    34      0    36    3'+    35 

19     20     3^     21     34      0      0      022      0340    23      0 

35   0  37  35   0   0   0  24   0   0  25   0  26   0 

0   0  27   0  28   03^   0  35   0   0  36   c  35 

0  29  0  0  yt    30  31  0  32  33  0  0  c  0 

AY(126)  =10000000000000 

00000000-10010-1 
00000000000000 
100-10000000000 

(Contd,) 
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3 

0 

4 

0 

5 

0 

7 

8 

0 

0 

35 

0 

37 

35 

0 

16 

0 

34 

0 

17 

AV(126)  « 
(Contd. ) 

0 
0 

0 
0 

0 

1 

0 
0 

0 
0 

0 

0 

0 
0 

0 
0 

-1 

0 

1 

0 

0 
0 

1 

0 

0 
0 

-1 

0 

1 

0 

0 

-1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-1 

0 

0 

1 

0 

"1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 
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APPENDIX.  A3 

SECONDARY  DRAG  EQUATIONS 

The  secondary  drag  equations  presented  here  are  the  state  space 
form  of  the  similar  equations  in  Lockheed1 s  model  (B-9). 
Variables     u   v   w   p   q   r 
Indexes  (k)   1   2   3   4   5   6 
(KM)      6   5       3   2 
Region  Determination 

Region  1   T  <  L-j  -  Lg  or  T  >  L, 
Region  2   L,  -  Lg  <  T  <  Lj 
Values  of  T 

v,  r   T  =  v/-r     Indexes  2,  6 
w,  q   T  »  w/q      Indexes  3»  5 
Values  of  L  for  DSRV 

* 

L  -  23.40  ,  Ls  -  46.95  »  Lx  "  Ls  =  **23,55 
Equations  (KM  «  8  -  K) 
Region  1 

K~2f3       XC  =  C1KxK      1^1    +C2KxKK    |xK|  + 

C3K  Sign  (xK)   x*H 

K^5,6       XC^C6KxKH    |xKM|  +C5KxK    |xKM|  + 

C?K  Sign   (xK)   x* 

Region  2 

K  -  2,3       XC  -  Sign   (xKM)   x*   (C^K  Xj/x^  +  C^)  + 

C6k  XK    |XKMl  +  CVK  *KM    lXKii! 
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K  -  5,6   XO  -  Cu  y.K  |>:k|  +  Sign  (>:y)   x»  [C^  (x^/x^  + 
Cac^  +  V  XKH  M 

Values  of  Forces  and  Konents 

K  -  2,  6   X  -  YC  *■  Yvy       Yyv  ^  x  (30)  -  X(24) 
K  -  3,  5   X  -  XC  *  Z^       Z>;w  -  x  (#)  -  X(J;8) 

Values  of  Parameters  C 

JLK 

There  are  28  values  of  these  parameters  1  <  I  <  7i  K  •■  2,  3. 

5t  6  in  the  vector  P  starting  at  P  (72)  =  C  ?  and  running  in 
groups  of  7  in  the  order  of  K. 
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APPENDIX  SJl 

ibm/ssp  subroutines  used  in  this  thesis 
" subrouti ne  gauss  i i x,s,am,v) 

A*OoO 

DO    50    1=1,12 
CALL    RANDlH  IX, IY,Y) 
IX=IY 
50    A-A  +  Y 

V=(A-6^0)::S+AM 

RETURN 

END 
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SU3RGLTINE  RANDU( IX,IY,YFL) 
IY-IX*5  65539 
IF( I Y) 5,6,6 

5  IY^IY+2147463647+1 

6  YFL=IY 

YFL=YFL*o ^656613E-9 

RETURN 

END 
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10 


SUBROUTINE    GMPRDC A ,B,R » N,  ?■ ,  L  ) 
DIMENSION    All  J, BUI  ,RC1) 
IR  =  0 
IK=-M 

00  10    K=1,L 
IK=1K+iM 

03    10    J=1»N 

IR=IR+1 

JI=J-N 

1  3=  IK 
RUR)  =  0o 

03    10    1=1, M 

JI-JI+N 

IB=IB+1 

R( IR)  =  RUR)  +  A(JI)*B(IB) 

RETURN 

END 
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SUBROUTINE    S IMQ( A, 6, N,KS) 
01  MENS  I CN    Ad)  ,6(1) 

C 

C  FORWARD    SOLUTION 

C 

TGL  =  0o0 

KS  =  0 

JJ=-N 

DO    65    J=1,N 

JY=J+1 

JJ=JJ+N+1 

BIGA=0 

IT=JJ-J 

DO    30    Z  =  J,N 
C 

C  SEARCH    FOR    MAXIMUM    COEFFICIENT    IN    COLUMN 

C 

IJ=IT+I 

IF( ABS(BIGA)-ABS<A{  I  J)  )  )  20,30,30 
20  BIGA=A(IJ) 

IMAX=I 
30  CONTINUE 
C 

C         TEST  FOR  PIVOT  LESS  THAN  TOLERANCE  (SINGULAR  MATRIX) 
C 

IF(ABS{BIGA)-TOL)  35,35,40 
35  KS  =  1 

RETURN 
C 

C  INTERCHANGE    ROWS    IF    NECESSARY 

C 

4 3    Ii  =  JM<    (J-2) 

IT=IMAX-J 

DO    50    K=J,N 

I1=I1+N 

12=1 1+  IT 

SAVE=A(I1) 

A(  I1)  =  MI2) 

A(I2)=SAVE 
C 

C  CIVIDE    EQUATION    BY    LEACING    COEFFICIENT 

C 

53    At I1)=A{ II l/BIGA 

SAVE=B(IMAX) 

B( IMAX)=B( J) 

B( J)=SAVE/B1GA 
C 

C         ELIMINATE  NEXT  VARIABLE 
C 

IF(J-N)  55,70,55 
55  igS  =  N:'-:(  J-l  ) 

DO  65  IX=JY,N 

IXJ=IQS+IX 


60 
65 


70 


30 


IT=J- IX 

DO    60    JX=JYSN 

IXJX=N*(JX-1)*IX 

JJX=IXJX+IT 

A(  IXJX)=A(  1XJXJ-IAI  J.XJJ  A  {  JJX)  ) 
B(IX)=B(  IX)-(  L'(  Ji;A(  IXJ)  ) 

BACK  SOLUTION 

NY=N-1 

IT«N*N 

DO  80  J=lfNY 

IA=IT-J 

IB=N-J 

IC=N 

DJ  80  <=1,J 

B( lB)  =  e(  IS)-A(  IA)  >B(IC) 

IA=IA-N 

IC-IC-1 

RETURN 

END 
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SUBROUTINE  MI  NV ( A, N  »  D ; L , M  ) 
DIMENSION  A(1)»L(1)  ,M(1  ) 

C 

C        SEARCH  FOR  LARGEST  ELEMENT 

C 

NK=-N 

DO  80  K=1,K 

NK=NK+N 

L(K)=K 

H  <  K  )  -  K 

KK=NK+K 

BIGA=A(KK) 

DO  ZO  J=K,N 

IZ=N  *< J-l) 

DO  20  I=KfN 

IJ=IZ+I 
1J  IF(  ABS(BIGA)-  ABS(AUJ)))  15,20,20 
15  BIGA=A(IJ) 

L(K)=I 

M(K)=J 
20   CONTINUE 
C 

C        INTERCHANGE  ROWS 
C 

J-L(K) 

IF(J-K)  35,35,25 
25    KI=K-N 

00  30  1=1, N 

K  I  =  K I  +  N 

HCLD=-A(KI ) 

JI=KI-K+J 

A  ( K I ) «  A  i  J I J 
C 

C         INTERCHANGE  COLUMNS 
C 

30  4{JI)  =HOLO 
2  5  I=M(K) 

IF(I-KJ  45,45,38 
33  JP  =  N-. (1-1) 

DO  40  J=1,N 

JK*NK+J 

JI=JP+J 

HuLD=-AUK) 

A( JK)=A( JI  ) 
40  AC  JI )  =HOLD 
C 
C        DIVIDE  COLUMN  BY  MINUS  PIVOT  (VALUE  OF  PIVOT  ELEMENT  IS 

C         CONTAINED  IN  BIGA) 
C 

45  IF(BIGA)  48,46,48 

4S  0  =  0.0 
RETURN 


4  3  DJ  5  5  1=1 fN 

IFCI-K)  50,55,50 
3G  [K-hK+I 

At IK)=A( lK)/(-BIGA) 
5?  CONTINUE 
C 

C         REDUCE  MATRIX 
C 

•   DO  65  1  =  1, N 
IK=NK+I 
HOLC=A(IKI 
IJ=I-N 
DO  65  J  =  1,N 
I J=IJ+N 

IF(I-K)  60,65,60 
60  IF(J-K)  62,65,62 
62  KJ=IJ-I+K 

A( IJ)=HCLOvA(KJJ+A( IJ) 
65  CONTINUE 
C 

C        DIVIDE  ROW  BY  PIVOT 
C 

KJ=K-N 
DO  7  5  J  =  i,N 
KJ=KJ+N 

IFiJ-Kj  70 ,75, 7 C 
7J  A(KJ)=A(KJ  )/BIGA 
15    CONTINUE 
C 

C         PRODUCT  OF  PIVOTS 
C 

D  =  D'%3IGA 
C 

C         REPLACE  PIVOT  BY  RECIPROCAL 
C 

A(KK)=lo O/BIGA 
60   CONTINUE 
C 

C        FINAL  ROW  AND  COLUMN  INTERCHANGE 
C 

K  =  .< 
ICO  K  =  (K-1  ) 

IF(K)  150,150,105 
1C5  I=L(K) 

IFCI-K)  120,120,108 
1C3  JQ=N«(K-I) 
JR=N  '<  1-1) 
DO  liO  J=1,N 
JK=JQ+J 
HOLD=A(JK) 
JI=JR+J 
A( JK)=~A( JI) 

110  A(JI)  =HOLD 
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UG 


125 


IF( J-K) 


100,100,125 


130 


150 


DO  130  1=1 fN 

KI  =  KHN 
HGLD-A(KI) 
JI=KI-K+J 
A(KI  )=-A( JI) 
A(JI)  =H0LD 
GO  TO  100 
RETURN 
END 
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APPENDIX  A5 

CONTOURING  AND  PLOTTING  SUBROUTINES 

S UBROUT I N E    CONTUR ( NO, X , Y , Z , N,N , NS  1 

C 

C  --:  •■  :  ■  ■'•     ■■■■■  ■  ■■    ■    ■  .  .   ■:;-..:•■:,:.::. ......     ■  ; 

C 

C  SUBROUTINE  CCNTUR 

C 

C  PURPOSE 

C  PLOT  SEVERAL  CONTOURS  OF  A  Z  VARIABLE  VLRSUS  TWO 

C  BASE  VARIABLES  X  ANC  Y  IN  A  FORM  SUITABLE  FOR 

C  THESIS  USE 

C 

C  USAGE 

C  CALL  CONTUR(NO,X,Y,ZfK,NfNSI 

C 

C        DESCRIPTION  OF  PARAMETERS 

C  NO  -  CONTOUR  NUMBER  OF  AE.   3  DIGITS 

C  X   -  N  VECTOR  OF  BASE  VARIABLES,  VERTICAL 

C  Y   -  M  VECTOR  OF  BASE  VARIABLES,  HORIZONTAL 

C  Z   -  N*M  VECTOR  OF  CONTOUR  VARIABLES  STORED 

C  IN  COLUMNWISE  VECTOR  FORM 

C  N   -  NUMBER  OF  ROWS  IN  Zo  N  MUST  BE  o LEc   47 

C  M   -  NUMBER  OF  COLUMNS  IN  l9    M  MUST  BE  oLEi   51 

C  NS  -  CODE  FOR  DATA  SORTING  IN  ASCENDING  ORDER 

C  0  -  NO  SORTING 

C  1  -  SORT  X 

C  2    -    SORT  Y 

C  3  -  SORT  BOTH  X  AND  Y 

C 

DIMENSION  X(1),Y(1),ZI1) 
C         REN.  ARKS 

C  (1)-  THE  CONTOUR  IS  CONSTRAINED  BY  THE  FORMATS 
C  TO  A  47  LINE  BY  5i  SPACE  ARRAY  FOR  THESIS 

C  USAGE 

C  (2)-  THIS  PROGRAM  REPRESENTS  A  HIGHLY  MODIFIED 
C  VERSION  OF  SUBROUTINE  PLOT  IN  THE  IBM  360 

C  SCIENTIFIC  SUBROUTINE  PACKAGE 

C  (3)-  SUBROUTINE  CCNTUR  HAS  Tl-.O  OUTPUTS 
C  1  -  BOX  LISTING  THE  CONTOUR  PARAMETERS 

C  ON  ONE  PAGE 

C  2    -  CONTOUR  PLOTTED  ON  THE  NEXT  PAGE 

C 

C         SUBROUTINES  AND  FUNCTION  SUBPROGRAMS  REQUIRED 

C  NONE 
C 

C         AUTHOR 

C  MICHAEL  No  HAYES  , RMo 5-333 ,M IT  X68C7 
C 

c 

DIMENSION  0UT(5l)  ,  YPR  (6  ) ,  YPT(  3  ) 
DIMENSION  IANG(21 ) ,ZD(21) 

0  INTEGER  IANG/'l1,  '2', '3S  «4]f  »5«,  ^  S  'T', '8', '9','A', 

1  •  B  '  ,  '  C  c  , ■  D  •  , «  E  •  , '  F  •  ,  •  G  '  ,  •  H '  ,  ■  J  ■  ,  '  K  ' , ■  L  ■  ,  •  M  •  / 
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INTEGER  OUT 

FORMAT  STATEMENTS  FOR  THESIS  USE 

1  FORMATQHi,27X,7HCQNTOUR,lX,I  8) 

2  FORMAT (1H    , ElOc 3, ' * • , 51 Al  ,  ■ v •  ) 

3  FCRMATQH    ,10X  : «  :  ■  ,51X ,  ■  :  •  ) 

40FORMAT ( lHi, 6X » 36H  , 

11  5H:.  *<  ***  •''•"••      ■'•   ) 
50FCRMAT(1H  tSX,1*1  ,12X ,7HCCNT0UR , IX , I  3 , 12H   PARAMETERS, 

116X, •*  '  ) 
6CFCRMATUH  ,5X,,:v',10H  X  RANGE  :,ElU4f4H  TO  ,  E1U4, 

14H    DX=,Ello4, »*■ ) 

7  OF  ORM  AT  (  1H      »  1 1  X  »  36  H  »:o  o  o  c  :^o  c  0  o :::o  o  o  o  :-  o  o  o  o  "^o  o  c  o  *o  oo  c  '••  o  o  c  c  •'   » 
1 1  5  H  ^  o  o  o  '•"•  o  •  o  o  *©•©«*  I 

80FJRMAT(1H    »3X,E9o2flXfE9o2tlXfE9o2tlXfE9«2»lXtE9o2tlXi 

1E9o2) 
90FJRMAT(1H    ,5X,«*«,10H    Y    RANGE     :fEUo4t4H    TO    ,E11»4« 

14H    DY=tEllo4,  •*« J 
130F0RMAT(1H    ,  5X  ,  •*  •  ,  10H    Z    DCMAI  N:  ,  El  1«4  ,  4H    TO    ,Ello4i 

14H    CZ=tEllo4i •*») 
170F3RMAT(1H    , 5X,'*',27H    Z    DOMAINS    FOR    THE    CONTOURSi 

121H    :MAX    VALUES    FOR    EAGH  ,3X  , ' *»  ) 
20  0F3RMATUH    f5Xf,*«t4H    NO. »  12 1 EHe4f 4H    NOetI2i 

1E11o4,4H    NOa9I2»E11.4y1*1 J 
230FOR.MAT  ( 1H     , 6X»36H     '•'  '^  i 

115H***5 ***********  ) 

60  FORMAT (1H     tl8X,«    *aooe*    INCREMENT    IS       ■  fE1507) 

61  FORMATUH    , 8X  ,E15o 7,5X, E15o 7, 5X , El 5o 7 ) 
NL=47 

NTH^51 

ZC0N=lo99 

NCCNT=2  3 

NLL=NL 

SORTING  ROUTINES 

NSKIP=0 

IF(NS-1)105,1C1,I02 
102  IF(NS-2)105f103,104 
1  C  ^  NSKIP=1 

SORT  X 
101  00  15  1=1 v N 

DO  14  J=I,N 

IF(X(1  )-X(  J)  )  14,14,11 

11  F=X{  I) 
X(I  )=X( J) 
X(J)=F 
L=I-N 

LL  =  J--N 

00  12  K=lt« 

L  =  L  +  N 

LL=LL+N 

F=Z(L) 

Z(L)=Z(LL) 

Z(LU=F 

12  CONTINUE 
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14 
15 


103 


21 


22 
24 
25 

1C5 


40 


CCNTIMIE 

CONTINUE 

IF(NSKIP)105, 

SORT  Y 

OJ  25  1=1, M 

DO  24  J=I,M 

IF(Y( I )~Y(  J)  ) 

F=-Y(  I) 

Yd  )  =  Y(J) 

Y( J)=F 

L  =  (  1-1  >*N 

LL=(J-1)  N 

Da  22  K=lfN 

L=L  +  1 

LL=LL+1 

F=Z(L) 

Z(L)=Z(LL) 

Z(LL»=F 

CONTINUE 

CONTINUE 

CONTINUE 

FIND  BASE  VAR 

XSCAL=(X(N)-X 

YSCAL=(Y(M|-Y 

SET  BLANK 

BLANK=0 

FIND  CCNTOUR 

7.MIN  =  130E75 

ZMAX=-lcOE75 

Ml=l 

H2=N*M 

DO    40    J  =  M1  ,M2 

IF(Z( J  JoGToZM 

IF(Z( JJoLToZM 

CONTINUE 

LINEAR    INTERP 

ZSCAL=(ZMAX-Z 

IF(ZSCALoEQoO 

DEVELCP    AND    P 

XMIN-X(l) 

XMAX--X(N) 

YMIN=Y(1J 

YMAX=Y(MJ 

WRITE(6,4) 

V*RITE(6,5)N0 

WRITE(6,6)XMI 

WRITE(6,9)  YM 

WRITE (6,13) ZM 

WRITE(6,17) 

ZC(l)=ZMIN+(2 

NZCAL=NCCNT-2 

DO  18  IZ=1,NZ 

ZD( IZ+1)=ZD(1 


105,103 


24,24,21 


IABLE  SCALES 

(1) )/(FLCAT(NLL-l) ) 

(1) )/<FLOAT(NTH-l) ) 


VARIABLE  SCALE 


AX)ZMAX=Z( J) 
IN)ZMIN=Z( J) 

CLATICN  FOR  NCONT  CONTOURS 

MIN) /FLOAT (NCCNT-1 ) 

9  )ZSCAL=loOE-40 

RINT  CONTOUR  PARAMETER  BOX 


Nf XMAXiXSCAL 
N, YMAX, YSCAL 

IN,ZMAX,ZSCAL 

,0-ZCON)*ZSCAL 

CAL 

)+FL0AT( IZ)*ZSCAL 
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13 


19 


90 


45 


5C 


55 


35 


37 


30 


CCJNTIN 

ZDtNCG 

IP  =  7 

DO    19 

M  =  IZ 

N2=N1+ 

N3=N2+ 

WRITEt 

CONTIN 

W  R I  7  L:  ( 

CALCUL 

YPRtl ) 

DO    90 

YPRtKN 

CGNTIN 

YPR(6) 

YPT(3  ) 

YPT(2) 

YPT(3) 

YSTAR= 

PRINT 

WRITE ( 

WRITEt 

WRITEt 

WRITEt 

WRITEt 

FIND    T 

X8  =  XU 

L  =  l 

1=1 

XEPS=X 

YEPS=Y 

F=FLGA 

XPR=XB 

XQIF=X 

IFtXCI 

FIND    T 

DQ    5  5 

OUTt  IX 

CONTIN 

K  =  l 

LM1 

Y3=Ytl 

G=FLOA 

YP=YB+ 

YOIF=Y 

IFtYDI 

FIND    C 

JZ=(LM 

JP=IFI 

OUTtK) 

LP=LM+ 

K  =  K  +  1 


UE 

NT) -7.  MAX 

IZ=1?  IP 


IP 

IP 

6,2 

UE 

6,2 

ATE 

=Y( 

KiV-- 

+  1) 

UE 

=Yt 

=YM 

=YM 

=  YM 

YSC 

FEA 

6,1 

6,6 

6,6 

6,8 

6,7 

FE 

) 


0)N1,ZD(N1),N2,ZD{N2) >N3,ZD(N3) 

3) 

THE    Y    SCALE    VARIABLES 
1  ) 
1,4 
=  YPR(KNH  YSCAL-:  ICoO 

HI 

IN 
IN+YSCAL*25oO 

AX 

AL*5oO 

DING 

I  NO 

OIYSTAR 

11 (YPTt IP),IP=1,3) 

)  (YPRt  IP)  ,IP  =  1,6) 

) 

X    SCALE    PRINT    POSITION 


SCAL/FLCAT12-MNLL-1  )  ) 

SCAL/FL0AT(2;MNTH-1  )  ) 

Ttl-l) 

♦F*XSCAL 

(L)-XPR-XEPS 

FJ50f50,70 

FE  Y  SCALE  PRINT  POSITION 

IX=1,NTH 

)=BLANK 

UE 


) 
T(K 

G^Y 
(LM 
F)3 
CNT 
-1) 
Xtt 
-IA 
1 


-1) 

SCAL 

)~YP-YEPS 

0,30,31 

OUR  POSITION  ANC  MAGNITUDE 

.-•N  +  L 
(Z(JZ)~ZMIN)/ZSCALHZCON) 

NGt JP) 
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34 


33 


70 

80 

6  4 


65 


IF(K-NTh»35,34,36 

YP=Y(M) 

GO  TG  37 

PRINT  THE  LINE 

WRITE(6,2)XPR,  (CUT(  IZ),  IZ  =  I,NTI'.) 

L=L  +  1 

GO  TC  80 

SKIP  THE  LINE 

WRITE(6,3I 

1=1  +  1 

IF(I-NLL>45,84t86 

XPR=X(N) 

GO  TO  50 

PRINT  BOTTOM  AND  Y  VARIABLE  SCALE 

WRITE (6, 7) 

WRITE  (6,  8)  (YPR(  IP),  IP  =  3.  ,6) 

RETURN 

ENC 
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SUBROUTINE  PLOT ( NO , A , N , M , N  S ) 

*  n  .• .  -.  : ••. 

SUBROUTINE  PLOT 

PURPOSE 

PLOT  SEVERAL  CROSS  VARIABLES  Y  VERSUS  A  BASE 
VARIABLE  X  IN  A  FORMAT  SUITABLE  FOR  THESIS  USE 

USAGE 

CALL  PLCT(NO,A,N,M»NS) 

DESCRIPTION  OF  PARAMETERS 

NO  -  PLCT  NUMBER  OF  c LEo   3  DIGITS 

A   -  MATRIX  OF  DATA  TO  BE  PLOTTED.  MUST  BE  IN 
STANDARD  SINGLE  COLUMN  FORM*  FIRST  COLUMN 
REPRESENTS  BASE  VARIABLE  AND  SUCCESSIVE 
COLUMNS  ARE  THE  CROSS  VARIABLES  (MAXIMUM  IS 
NINE)o  BASE  VARIABLE  IS  VERTICAL.-. 

N   -  NUMBER  OF  ROWS  IN  MATRIX  Ac  N  MUST  BE 
oLEo   47 

M   -  NUMBER  OF  COLUMNS  IN  MATRIX  Ac  M  MUST  BE 
oLE    10 

NS  -  CODE  FOR  SORTING  THE  BASE  VARIABLE  DATA  IN 
ASCENDING  ORDER 

0  SORTING  IS  NOT  NECESS ARY ( ALREADY  IN 
ASCENCING  ORDER) 

1  SORTING  IS  NECESSARY 

DIMENSION  OUT  (51)  ,  YPR  (  6  )  ,  I ANG  (9  )  , A  ( 3. )  ,  YPT  (3  ) 

REMARKS 

(1)-  THE  PLOT  IS  CONSTRAINED  BY  THE  FORMATS  TO 
A  47  LINE  BY  51  SPACE  ARRAY  FOR  THESIS  USE 

(2)-  THIS  PROGRAM  REPRESENTS  A  SIGNIFICANTLY 
MODIFIED  VERSION  OF  ITS  NAMESAKE  IN  THE 
IBM  360  SCIENTIFIC  SUBROUTINE  PACKAGE 

(3)-  THE  PLOT  STARTS  IN  THE  UPPER  LEFT  CORNER 

SUBROUTINES  AND  FUNCTION  SUBPROGRAMS  REQUIRED 
NONE 


AUTHOR 

MICHAEL    No     HAYES    ,RMo 5-333 , MIT    X6807 

********  .  •-. :.  *****  ****  *********** 

INTEGER    IANG/*lat  "2ai  '3«  t  «4S  «5«  ,  •<&•»  «7«  ,  «8%  «9«/ 

INTEGER    CUT 

FORMAT  STATEMENTS  FOR  THESIS  USE 

1  F0RMAT(iHi,27X,7H       PLOT    ,18) 

2  FQRMATUH     ,  El  0=  3  * c  *  '  ,  51  Al ,  ■*■  ) 
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10 


11 


12 
14 
15 

16 


4C 


3  FORMAT 

4  FORMAT 

5  FORMAT 
70 FOR MAT 

1  1  J  Ho  o  o 

30F0RMAT 
1E9o2) 

9  FORMAT 
NL=47 
i\ITK  =  51 
NLL=NL 
IF(NS) 
SORTIN 
DO  15 
DO  14 
IFtAU 
L=I-N 
LL=J~N 
DO  12 
L=L*N 
LL=LL+ 
F=ML) 
A(L)=A 
A(LL)= 
CONTIN 
CON TIN 
SET  BL 
BLANKS 
FIND  B 
XSCAL= 
Ml=N-!-l 
YM/>X=- 
YMIN=1 
M2  =  N  N 
DO  40 
IF  <A( 
IF  <A( 
CCNTIN 
YSCAL= 
IF1YSC 


90 


(1H  ,10X,»: • ,5 IX: • : • ) 

(1H  ,18X,«  *«•*•*  INCREMENT  IS   »,E15.7) 

(1H  i8X,E15„7,5XfE15*7,5X,E15o7l 

(1H  ,  11X,  36H*oo«b*»oco*ooo»'  ooo  o*»oo«*o  oa       a*8 

o  <-  a  o  j  ■  o  o  o  o  *  ■  ) 

(iH  »3X,E9o2flXfE9*2flX,E902flX,E9o2flXtE9o2flX1 

(1H  ) 


16,16,10 

G  ROUTINE 

J.  =  1 ,  N 

J=I,N 

)-A( J) 114,14,11 


K  =  1,M 
N 

CLL1 

F 

UE 

UE 

ANK 

C 

ASE  AND  CROSS  VARIABLE  SCALES 

(A(N)-A(l) )/(FLCAT(NLL-l) ) 

lo0E75 
o0E75 


J=M1,M2 

GTc  YMAX)  YMAX=AIJ> 
LT«  YMIN)  YMIN=A<J) 


DO  90 

YPRCKN 

CONTIN 

YPR(6) 

YPT(l) 

YSTAR= 

YPT(2) 

YPTO) 

PRINT 

WRITE( 

WRITE  ( 

WRITE( 


J)  O 

J!  B 

UE 

(YMA 

ALo  E 

»YNI 

KN=1 

+  1)  = 

UE 

=  YMA 

=  YMI 

YSCA 

=YMI 

=  YMA 

HEAD 

6,1) 

6,4) 

6,5) 


X-YMIN)/50cO 

Q^O  )YSCAL=1o0E-40 

N 

,4 

YPR(KN)+YSCAL*10«0 

X 

N 

L*5o0 

K*YSCAL*25«Q 

X 

ING  AND  CROSS  VARIABLE  SCALE 

NO 

YSTAR 

(YPT(  IP),IP=1,3) 
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45 


50 


55 


60 


70 
80 

Ik 


66 


WRITE 

WRITE 

FIND 

XB  =  A( 

L=I 

MY  =  M- 

1=1 

XEPS  = 

F  =  FL0 

XPR=X 

X0IF  = 

IF(XD 

FIND 

DO  55 

OUT(  I 

CONTI 

DO  60 

LL=L  + 

JP  =  (  ( 

OLT(J 

CONTI 

PRINT 

WRITE 

L  =  L  +  1 

GO  TC 

WRITE 

1=1  +  1 

IF(  I- 

XPR=A 

63  TO 

PRINT 

WRITE 

WRITE 

WRITE 

RETUR 

END 


(Gj 8)  (YPR(  IP),IP  =  1  ,6) 
(6,7) 

RASE  VARIABLE  PRINT  PCSITION 
1) 


XSCAL/FLCAT(2<:  (NLL-1  )  ) 

AT(I-l) 

B+r-XSCAL 

A1U-XPR-XEPS 

IF } 50, 5  0 , 7  0 

CROSS  VARIABLES 

IX=1,NTH 
X  l=BLANK 
NUE 

J  =  1,N.Y 
J*N 

A(LL)-YHlN)/YSCAL)-MoC 
P)=IANG( J) 
NUE 

LINE  AND  CLEAR,  CR  SKIP 
(6,2)  XPR,  (CUT(  17.)  ,IZ  =  1,NTH) 

80 
(6,3) 

NLL)45f84,86 

(N) 

50 

BOTTOM  AND  CRCSS  VARIABLE  SCALE 
(6,7) 

(6,8) (YPR(  IP)  ,IP  =  1,6)  . 
(6,9) 
N 
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APPENDIX  A6 

CHAPTER  D?  SUBROUTINE'S   (OYKOD) 

SUBROUTINE    OVMODC ME, AV,XF,P, IN, U,NE,X,XN, XD,XON, KB, LI 

•■  •  --:    ■•  :'  ■"•  -•  -:-;  ••■•... 
SU3ROUTINE    CVMOD 

PURPOSE 

TC  COMPUTE:  ANY  SELECTED  COMBINATION  CF  THE  TOTAL  LINEAR 
AND  ANGULAR  ACCELERATIONS  AT  A  GIVEN  TIME  FOR  A  GENERAL 
OCEAN  VEHICLE  INCLUDING  ALL  DESIRED  INPUTS  AND, IF 
SPECIFIED, A  NOISY  ENVIRONMENT 
EQUATION- 

ADX/CT=EE(XKIJ.XI-.XJ)+XEFFECTORS+XGRAVITY  + 

XDISTURBANCES+XCCNSTANT+XSECCNDARY 
WHERE-  E  IS  SUMMATION  FOR  6  DEGREES  OF  FREEDOM  CR 
ANY  SELECTED  COMBINATION  CF  6  DEGREES 

LANGUAGE  :  FORTRAN  IV 

S18R0UTINES  REQUIRED 

TANKS,GRAVT,ACALC,SHCAL,XDCAL,SIMQ,XD1ST 

DESCRIPTION 

CHAPTER  D2, Mo  N.HAYES  THES IS, MITt 1971 , NAME  DEPARTMENT 

■*>  ?•:  !'  ;'"!:>.  I   ".  .  .  ■  •:  V---1-"!- ■'.'■:■  ■'.-  -':■  ":<-;•-'.  ..■'.■".  .  .   .  ' 

INTEGER  AV,XF 
ODI MENS  ION  ME(1)  ,  AV (1 )  ,XF ( 1  )  , P { i ) , IN ( I  )  ,U ( 1 ) ,NE1 1 ) , 
IX ( 1 J,XN(1),XD(1  ),XCN( 1) ,L(1) 
DIMENSION  XGRAV(6)  ,  XPD  (  6  )  ,  PG(  8  ) ,  XS  (6  )  ,  A(  36  J  ,  *N{  36  ) 
C      SETUP  FOR  TANKS  AND  GRAVITY  CALCULATIONS 
C      SET  PG  INITIALLY  FROM  P 
MT=ME( 171-1 
DO  5  KT=1,8 
PG(KT)=P(MT+KT) 
5  CONTINUE 
C     TEST  FOR  TANKS  CALCULATIONS 
IF(ME(1)cNEd1 JGO  TO  1 
CALL  TANKS(P,ME(iO) ,U,NE( 1) ,PG) 
C      CALCULATE  GRAVITY  FORCES  AND  MOMENTS 

1  CALL  GRAVT(ME(8)  ,U,NEUO)  ,PG,XGRAV,KB,L) 

C      CALCULATE  THE  DERIVATIVE  TRANSFORATION  MATRIX  -  A 

MG=ME( 18)+1 

G--P(MG) 

CALL  ACALC(P,PG,G,A,KB,L) 

IKB«KB*KB 

DO  19  I  A  =  1,1  KB 

AN( IA)=A( IA) 
19  CONTINUE 
C      BEGIN  NOISY  AND  NOISELESS  DERIVATIVE  EVALUATIONS 

ISW=1 

IF(ME(6)oEQ3l)GG  TO  3 
C      TEST  FOR  SHROUD  CALCULATION  -  NOISELESS 

2  IF(ME(3)oNEol JGO  TO  6 

OCALL  SHCAL(P,ME(12) ,X,U,NE(7),NE(2 )  ,NE ( 1 1 ) ,NE <  1 ;  )  5 
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16 
13 

15 


10 


20 


1XS,KB,L) 
C     CALCULATE  NOISELESS  FORCES  AND  MCMENTS 

6  DO  7  K=1,KB 
KX  =  L(K  ) 

CALL  XCCAL(ME,AV,XF,PtPG,U,NE,X,XCC,KB,L,KX) 
IF(ME(3)oNEo  DGO  TO  9 

XPC(K)=XDC+XGRAV(KX)+XS(KX) 

GJ  TO  7 
9  XPD(K)=XDC+XGRAV(KX) 

7  CONTINUE 

C     SETUP  AND  SOLVE  SIMULTANEOUS  EQUATIONS  FOR 
C     NJISELESS  DERIVATIVES 

IF(KBc  EQoDGO  TO  20 

CALL  SIMQ(  A,XPC,KB,KSir.) 
C     TEST  FOR  VALID  SOLUTION 

IF(KSIM3EQoO)GO  TO  8 

WRITE(6,18) 

FORMAT (IX, «S1MQ  IN  OVMOD  GIVEN  SINGULAR  /^-MATRIX') 

WRITE(6,15)(PG( J) ,J=1,8) 

FORMATUX,  fPG=',8E15o7) 

DO  10  K=1,KB 

XC(K )=0o 

XCN(K)=Oo 

CONTINUE 

RETURN 

IF(A(l)oEQoOo )GG  TO  16 

XPD(1)=XPD(1)/M1) 
C     PLACE  CALCULATED  NOISELESS  DERIVATIVES  IN  XD 
3  DQ  11  K=1,KB 

XC(K)=XPD(K) 

11  CONTINUE 
GJ  TO  4 

C      CALCULATE  NOISY  FORCES  AND  MOMENTS 

3  IF(ME(9)o EQ?1)ISW=2 
C      TEST  FOR  SHROUD  CALCULATION  --  NOISY 
IF(ME(3)oNEol  )G0  TO  12 
OCALL  SHCAL(P,ME(12) ,XN, U , NE (7 ) ,NE ( 2 ) , NE ( 1 1 ) ,NE  ( 12 )  , 
1XS,KB,L) 
C     CALCULATE  NOISY  FORCES  ANC  MOMENTS 

12  DO  13  K=1,KB 
KX=L(K) 

CALL    XCCaL(ME,AV,XF5P,PG,U?KE,XN,XCC,KB,L,KX) 
CALL    XDIST(IN,P,ME(15) ,XN0,KX,6) 
IF(ME(3)oNEol )G0    TO    14 
XPC(K)=XDC  +  XGRAV(KX)  +  XS(KXMXNO 
GO    TO    13 
14    XPl(K)=XDC+XGRAV(KX)+XNO 

13  CONTINUE 

C     SETUP  AND  SOLVE  SIMULTANEOUS  EQUATIONS  FOR 
C     NOISY  DERIVATIVES 

IF(KBoEQcl)GO  TO  21 

CALL  SIMQ(AN,XPC,KB,KSIM) 
C      TEST  FOR  VALID  SOLUTION 
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IF(KSIMoECbl)GO    TO    16 
GO    TO    22 

21  IF(AN(  DoEQoOo  )GO    TO    16 
XPC(1)=XPD{1)/ANU ) 
PLACE    CALCULATED    NOISY 

22  OJ    17    K=1»KD 
XON(K)=XPD(KI 

17    CONTINUE 

GO    TO     (4,2),  ISW 
4    RETURN 
END 


DERIVATIVES    IN    XDN 
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SUBROUTINE    ACALC ( P  ,  PG  ,  G  ,A , KB , L ) 

C   SU3ROUTINE    ACALC 

C 

C   PURPOSE 

C         10    CALCULATE    THE    OCEAN    VEHICLE    A-MATRIX    CONTAINING 

C        ADDED    MASS    AND    INERTIA    TERMS 

C    SL3R0UTINES    REQUIRED 

C        NONE 

C 

C   DESCRIPTION 

C        CHAPTER    D2fMoNoHAYES    THES  I  S ,MI T , 197i ,NAME    CEPARTMENT 

C 

C 

DIMENSION    P(l) ,PG(i) , A ( 1 i  ,L(1) 

J  =  l 

Vtf=PG(l)/G 

DO    3  8    K=1,KB 

KP=L(K) 

DO    39    1=1, KB 

IM=L(  I  ) 

N=IM+6*(KM-1) 
OGO    TO     (1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18, 
119,20,21,22,23,24,25,26,27,28,29,30,3  1*32,33,34,35, 
236)  ,N 

1  AC=VM-P(1) 
GO    TO    37 

2  AC=Co 

G3    TO    37 

3  AC=0o 

GO    TO    37 
<i    AC=Oo 
GO    TO    37 

5  AC=VM:PG(4) 
GO    TO    37 

6  AC=-VM*PG(31 
GO    TC    37 

7  AC=Oo 

GO    TC    37 

8  AC=VM-P(8) 
GO    TO    37 

9  AC=0. 

GJ    TO    37 

10  AC=-VN*PG(4)-P(201 
GO    TO    37 

11  AC=Oo 

GO    TC    37 

12  AC=VM-PG(2)-P(32) 
GO    TG    37 

13  AC=0o 

GO    TO    37 

14  AC=0o 

GO    TC    37 
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15 


lb 


17 


13 


19 


20 


21 


22 


23 


24 


25 


25 


27 


23 


29 


3C 


12 

•a  a 

34 

35 

36 
37 

39 

3  3 


AOVM- 
GO    TO 
AC-VM* 
GO    TO 
AO-VM 
GO    TO 
AC=Co 
GO    TO 
AC  =  0& 
GO    TC 
AC=-Vf 
GO    TO 
AC=VMv 

GO    TO 
AC--P(3 
GO    TO 
AC  =  Oo 
GO    TO 
AC=Co 
GO    TG 
AC=VM' 
GO    TO 
AC=0o 
GO    TG 
AC=-VM 
GO    TC 
AC  =  Oo 
SO   TG 
AC=P(3 
G3    TO 
AC=Oo 
GO   TO 
AC=-VK 
GO    TO 
AC=VMv 
GO    TO 
AC  =  0, 
GO    TO 
AC  =  0;> 
GO    TG 
AC  =  Oo 
SO    TC 
AC=P(4 
A(J)=A 
J  =  J  +  1 
CONTIN 
CCNTIN 
RETURN 
END 


P115) 

27 

PG(3» 

37 

*PG(2)-P(27) 

37 

37 

37 
*P6(4)-PC10) 

37 

PG(3) 

37 

7)-P(22) 

37 


37 

PG(4) 

37 

37 

vPG(2)-P(17) 

37 

37 

S)-P(29) 

37 

37 
*PG(3) 

37 

PG(2)-P(12) 

37 

37 

37 

37 
2)-P(36) 

C 

UE 
UE 
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SUBROUTINE    XDCAL<ME,AV,XF,PtPGtU ,N,X, XD, KBf L, K) 

iU3R0UTINE    XCCAL 

PURPOSE 

10  COMBINE  COEFFICIENT  AND  EFFECTOR  FORCES  WITH  ANY 
SELECTED  GROUP  OF  EFFECTORS  AND  ANY  SELECTED  GRCUP  OF  6 
CEGREES  OF  FREEDOM  ,  SUBROUTINES  ARE  SPECIFIC  TO  THE 
OSRV  ,  CNLY  S6CCNC  DEGREE  COEFFICIENTS  USED 

iLKRGUTINES  REQUIRED 
XFUNS,SECAL,PRCALfTHCAL,COCAL 


ESCRIPTICN 
SEE  SUBROUTINE  CVMOD 
CHAPTER  D2fi'-1oNi  HAYES 


:■.. 


INTEGER  AV.XF 


10 
2 
1 


IS, MIT, 1971, NAME  DEPARTM 
=  (1),P(1) ,PG(1  ),U(1  )  ,N(1 


INTEGER  AV,XF 

DIMENSION  Mtll)  , AV ( 1 ) ,XF(1),P(1) , PG(1  ),U(1 ),N(1 
DIMENSION  L(l),PCf 8),NT<8) 
SET  PARAMETERS  FOR  XFUNS 
MC=ME( 18) 

PC(1)=PG(1)/P(MC+1) 
PC(2)=PG(2) 
PC(3)=PG(3) 
PC  <  ^  )=PG(4) 
PC(5)=P(37) 
PC(6)=P(39) 
PC(7)=P(42) 
PC(8)=P(43I 

BEGIN  PRIMARY  TERM  CALCULATIONS 
XD  =  Oo 

DO  1  1=1, KB 
I  P  =  L ( I ) 
DO  2  J=I,KB 

CALCULATE  PRIMARY  TERM  INDICES 
JM=L( J) 

IJK=IN+(  JP  (JF-1)  J/2+21  ■=:-  f  K- 1  > 
KIJ=IJK+6 

TEST  FOR  TERM  TO  BE  SKIPPED 
IF(XF(  IJK)oEQcO)GO  TC  2 
CALL  XFUNS(PC,X,KIJ,XC,XF) 

TEST  FOR  ABSOLUTE  VALUE  TERMS  AND  CALCULATE 
IF(AV(  UK)  )8, 10,9 
XD  =  XD  +  XC-:ABS(X(IM)  >*XUM) 
GO  TO  2 

XD=XD+XC^X( IM)*ABS( X( JM) ) 
GO  TO  2 

XD=XD*XC-:X(  IM)*X(JM) 
CONTINUE 
CONTINUE 

SECONDARY  TERM  CALCULATIONS 
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)  ,  X  (  1  ) 


IF( 

CAL 

XD  = 

PFQ 

IF( 

CAL 

XD-= 

ThR 

IF{ 

NT( 

•MT( 

DO 

NT( 

CON 

CAL 

XD  = 

CON 

IF( 

CAL 

XD  = 

RET 

END 


MF(2)cNEoi )GO    TO    3 

L    SECAL(PjME(ll ),X,XS, K,XSO,XSl) 

XD  +  XS 

PELLOR  CALCULATICNS 

ME(4)oNEc  1JGO  TO  4 

L  PRCAL(P»ME(i3) iX,U.N{6),N(3),XP,K) 

XD  +  XP 

LSTER    CALCULATICNS 

ME(5JoNEol  )GO    TO    5 

1)=N(4) 

2)=N(9) 

7     1=3,8 

I  >  -  N  (  I  + 1  0  ) 

TINUE 

L    THCAL(PfME(14),UtNTf X,XTfKI 

XD+XT 

STANT  TERMS  CALCULATICNS 

ME(7)oNEol )GO    TO    6 

L    C0CAL(P»ME(16)fX|XCa,K) 

XD+XCO 

URN 
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SUBROUTINE    XFUNS(P,X,K,XC,I ) 
SL3ROUTINE    XFUNS 

PtRPOSE 

TO  COMPUTE  THE  FUNCTIONAL  VALUES  OF  THE  SECCND  DEGREE 
COEFFICIENTS  OF  THE  DSRV 

SLBROUTINES  REQUIRED 
NCNE 


DESCRIPTION 

SEE  SUBROUTINE  XDCAL 

CHAPTER  D2fMoN0HAYES  ThES  I  S  ,M  I  T  ,  1971  ,NAME  CEPARTMENT 

... 
DIMENSION  PC  1)  tX(litUl) 
ISW=I(K-6I 

INITIAL  CONDITICNAL  GC  TO  STATEMENT,  BRANCH  TO 

PROPER  FUNCTION 
OGO  TC  (13, 14, 15, 17, 19, 21, 30, 31, 35, 37, 41, '.2,50,52,53, 
137,61, 62, 71? 72, 74, 79, 83,92, 95 ,97,101, 103 , 13  4, 11 8 ,119, 
2121,122,127,128,129,130),  I SW 

13  XC=X(K)-P(1) 
RETURN 

14  XC=P(1)*P(3) 
RETURN 

15  XC=X(K)  +  PU  )  P(2) 
RETURN 

17  XC=X(K)+P(1J 
RETURN 

19  XC=X(K)-P( 1)-  P(4) 
RETURN 

21  XC=X(K)+P(1)  P(2) 
RETURN 

20  XC=X(K)+P(1  ) 
RETURN 

21  XC=P(1)P(3) 
RETURN 

35  XC  =  X(K)-P(ir-  P(2) 

RETURN 
37  IF(X(1  LLT.Oc  )G0  TO  131 
XC=X(K)  "SIGN (Id ,X(1)  )-P(l) 
RETURN 
121  XC=X(K+126)'SIGN(lo ,X(1) )-P(l) 
RETURN 

41  XC=-P(l)vP(4) 
RETURN 

42  XC  =  P(i  )  P(3) 
RETURN 

50  XC=X(K)-P(1) 
RETURN 

52  XC=X(K)  +  P(1)*P(4)      ._ 
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RETURN 
5  3  IF(Xil)oLToOo )G0  TC  132 
XC-X(K)*SIGN( l0 ,X(I) )*P(1  ) 
RETURN 
122  XC=X(K  +  126H:SIGN(lo  ,X(i>  )  +  P(1.  ) 
RETURN 

5  7  XC  =  PC1  )  P(4) 

RETURN 

61  XC=X(K)-P(1);  P(2) 
RETURN 

62  XC=-P(1)  P(3) 
RETURN 

71  XC=-P(1)  '■  P(3) 
RETURN 

72  XC  =  X(K)-P(1  »*P(4I 
RETURN 

li    XC=P(1 )  P(3) 

RETURN 
79  IF{X(.l  )oLToOc  )G0  TO  133 

XC  =  X(K)  :SIGN(3.o,X(l)  )+P(l  )••  P(4) 

RETURN 

12  3  XC=X(K+126)  *SIGN(lc  ,X(1)  )  +P(1)  P(4) 

RETURN 

6  3  XC-X(K)+P(6)-P17) 

RETURN 
9  2  XC=X(K)+P<1)*PC2) 

RETURN 
5  5  IF(X(l)oLToOo )GO  TO  134 

XC=X(K)*SIGN(lotX(lJ )-P(l );  P(2) 

RETURN 

13  i    XC  =  X(K+126)»  SIGN  do  ,X(1)  )-P(l  )  P(2  ) 

RETURN 
97  XC=-P(1)*P(4) 

RETURN 
101  XC=X(K)+P(1)  P(4) 

RETURN 
103  XC=X(K)+PC7)-P(5) 

RETURN 
114  XC=X(K)+P(1)*P(2I 

RETURN 
113  XC=P(1  )  :p(3) 

RETURN 
119  XC=X(K J+P(5)-P(6) 

RETURN 

121  IF(X(l)oLTo0o )GO  TO  135 
XC=X(K)  :SIGN(1otX(1) )-P(l)-F(2) 
RETURN 

13  5  XC=X(K+126)#SIGN(U  ,  X  <  J.  )  ) -P<1  >-'P  <  2  ) 
RETURN 

122  XC=-P(i)  P(3) 
RETURN 

127  XOX(K) 
RETURN 
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123  IF<X(l)olTo03 )G0  TO  136 

XC=X(K) 

RETURN 
iio  XC=X(K+126) 

RETURN 

129  IF(X(3)oLTo0o )G0  TU  157 
XOX(K) 

RETURN 
137  XC=03 
RETURN 

130  IF( X( 1) )139, 138,138 

133  IF((X(2)-P(  8)*X(in»6To0o)G0  TO  127 

XC=X(K) 

RETURN 
139  IF((X(2)-P(  8)-:X{l)  loLToOc ,  )  GO  TO  137 

XC=X<K) 

RETURN 

END 
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SUBROUTINE    SEC AL ( P  ,K, X, XS ,K ,XSO , XST ) 

•****#** ... 

SUBROUTINE    SECAL 

PURPOSE 

TO   CALCULATE    TEE    SECCNDARY    CRAG    FORCES    AND    MOMENTS    FUR 
TEE    DSRV 

SLBROUTINES    REQUIRED 
NONE 


DESCRIPTION 

CHAPTER    D2,M0NuHAYES    THES ISfMIT, 1971 , NAME    DEPARTMENT 

DIMENSION    P(l)  ,X(1) 

INITIAL    SECCNCARY    DRAG    REGICN    DETERMINATION 

IF(  [K.EQelloORc  (KoEQ04)  )  GO    TO    1 

KM-8-K 

IF( (KoEQo2),OR^ (K^EQo6) )ISW=1 

IF((K« EQe 3L0Ro (K&ECo5) )ISW=2 

GJ    TO     (2,3) ,ISU 

K  =  2    OR    K=6    REGICN    DETERMINATION 

2  TA=X(2)  +  PlM  +  30)-:;X(6) 
TB=X(2)+P(M  +  2  9)  VX(6) 
XC=X(30) 
IF(X(6))17,i6,16 

16  IF((TAoGEoOa)eORo(TB«LE»Oo) JGO    TO    4 
I  SW  =  2 

GO    TO    5 

17  IF( (TAoLEoOo ) ,OR. (TB3GEo0o ) )GO    TO    4 
ISW  =  2 

GO    TO    5 

4  ISW=1 

5  GO    TO     (8,9) ,ISW 
1    XS=Oo 

XSC=Oo 
XST=Oo 
RETURN 
K=3    OR    K=5    REGION    DETERMINATION 

3  TA=X(3)-P(M+30) ■ X(5) 
TB=X(3)-P(M+29)*X(5) 
XC=X(54) 

IF(X(5  ))19,18,18 
13    IF( (TAoLEoOo )oCRo (TBoGEoOo ) )GJ    TO    6 

ISW=2 
GO    TO    7 
19    IF(  (TAcGEoOo  )oORo  (TBo  LEoOo  )  )GG    TO    6 

ISW  =  2 
GO    TO    7 

6  ISW=1 

7  GQ    TO    (10,3.1)  ,  ISW 

BEGIN    SELECTED    SECCNCARY    DR£G    CALCULATIONS 
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8  IF(KoECk2)G0    TO    14 

K  =  5    CR    K=6    REGION    CNE 
U    N=M+19+(K-5)*7 

OXS=AGS(X(KM) >*:(P<N)#X(KN)+P(N-1M X(K) )+ 
1 P  (  N+l  )  *S  1  GN  ( 1  „  7  X  (  K  M  )  )     X  {  K  )  ■  X  {  K  ) 

XS0=XS 

XST=XS 

xs=xs*xc 

RETURN 

9  IE(KoEQo2)GO    TO    15 
K=5    OR    K=6    REGION    TWO 

13  N=M+14+(K-5)     7 

OXS  =  P(N)---X(K)-  ABS!X(K5  }  4p(N*3)  *X(KMJ    ABS(X(K)  )  + 
lSIGNC'o  ,X(K>  )vX(K)  :X(K)v(P(N  +  2)   ■[  (X(Kii)/X(K)  )     -2     )  + 
2P(N+1)  ) 

XSC=XS 

XST=XS 

xs=xs-:  xc 

RETURN 

10  IF(KoEQc5)G0    TO    12 
K=2    OR    K=3    REGION    ONE 

14  N-M*(K-2)*7 

OXS=ABS(X(K) >*(P(N)*X(K)*P(N+1 )    X(KfM  )  + 
IP  (  N-J-2  )  ••  S  I  GN  (  lo  ,  X  (  K  )  }  ?  X  (  KM  )  ;<  X  (  KM  ) 

XSG^XS 

XST=XS 

xs=xs-  xc 

RETURN 

11  IF{KoEQo5)G0    TO    13 
K=2    OR    K=3    REGION    TWO 

15  N  =  M  +  3J.-(K-2)  -7 

0XS=SIGN(lo  ,X(KH)  )  &X(K)*X(K)*(P(N)*<X<K)/X(KMI  )  +  P(N-i-l  >  ) 
l+P(N+2 ) iX(K)     ABSU(KM) ) +P (N+3 )     X ( KM )     ABS ( X( KM ) ) 

xso-xs 

XST=XS 
XS=XS*XC 

RETURN 
END 
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APPENDIX  A? 

CHAPTER  D3  SUBROUTINES   (EFFECTORS) 

SUBROUTINE    TANKS  (  P,K,U,NT,PG) 

SUBROUTINE    TANKS 

PlRFJSE 

TO    COMPUTE    THE    VEHICLE    WEIGHT    AND    CENTER    OF    GRAVITY    OP 
A    GENERAL    OCEAN    VEHICLE    BASED    UPON    ITS    TANK    LOADINGS 

SL3ROUTINES    REQUIRED 
NCNE 

DESCRIPTION 

CHAPTER    D3,MoNoHAYES    THES  IS  ,MI T , 1971 ,NAMt    DEPARTMENT 

>  •    I  ■:  i  ■.:■,-.         . 

DIMENSION    P(l  )fU( 1  )  ,PG( 1) 
DW=Oo 
XDW=Oo 
YDW=Oc 
ZDW=Oo 
J=M 

DO    1    I=i,NT 
D=U( I)-P( J) 
D.4=DW  +  D 
K=J+NT 

XDW=XDW+D*P(K) 
K=K*NT 

VOW=YDW*D*P(K) 
K=K+NT 

ZDW=ZDW  +  DvP(K  ) 
J  =  J-H 
1    CONTINUE 
WT=PG(1)+DW 

PG  (  2  )  =  (  PG  (  2  )  *  P G  ( 1  )  ♦  X D  V, )  / M  T 
PG(3)=(PG( 3)*PG(1)+YDW)/WT 
PG(4)=(PG(4)     PG(i  MZDW )/WT 
PG(  l)=kT 
RETURN 
END 
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SUBROUTINE    GRAVT (M , A,N,P, X, K, L) 

SUBROUTINE    GRAVT 

PURPOSE 

TO    COMPUTE    THE    GRAVITY    FORCES    AiMO    MCKENTS    CN    A    GENERAL 
3CEAN    VEHICLE    BASED    UPON    ITS    HEIGHT, BUOYANCY, CENTERS    CF 
GRAVITY    AND    BUOYANCY, AND    VEHICLE    ANGLES 

SU3ROUTINES    REQUIRED 
NCNE 


DESCRIPTION 

CHAPTER    03, Mo  No  HAYES    THESIS fMIT,l97X , NAME    DEPARTMEI 

LOGICAL  AM 

DIMENSION  A(i),P(l),X(i),L(l) 

WMB=P(1)-PC5J 

SPH=SIN(A(N)  ) 

CFH=CCS(A(N)  ) 

STH  =  SIN(A(N  +  1  )  ) 

CTH=CCS(A(N+1)  ) 

AM=MoEQ„ 1 

DO  10  1  =  1,  K 

J=L(  I) 

IF(AMc,ANDo  (Jt  GT.3)  )J  =  J  +  3, 

GO  TO  (1,2,3,4,5,6,7,8, 9), J 

FORCE  EQUATIONS  FOR  BCTH  ZERO  AND  NON-ZERO;  Co B. 

1  X( J)=-WMB*STH 
GJ  TO  10 

2  X(  J)=V,NQ:  CTF- SPH 
GO  TO  10 

3  XC J)=WNB*CTH*CPH 
GJ  TC  10 

MOMENT  EQUATIONS  FOR  ZERO  CENTER  CF  BUOYANCY 

4  X  (  J  )  =  (  P  {  3  )  C  PH-P  ( 4  )  *SPH  ) •  P  i 1 H  CTH 
GO  TC  10 

5  X(J)  =  -PU  M  (P(2)  CTH-  CPH*P(4)  STH) 
GO  TO  10 

5  X(J)=P(1)  MP(2)*CTH*SPH*P{31*STH) 

GO  TC  10 

MCMENT  EQUATICNS  FCR  NCN-ZERJ  CENTER  OF  EUOYANCY 
7  OX  (  J-  3  )  =  CTH*  ( I  PC  3  )*PC  1  t-P(  7  )  •?  (  5  )  )  " -CPU  •-  (  P  (  A  )  ■   P  ( 1  )  -  P  (  8  M 
IP  (5)  )>   SPH) 

GO  TO  10 
30X  (  J-3  )=-  (  P  (  2  )  P  (  i  )-P  (  6  )*P  (  5  )  )  *CTH*CPH-<  PC  4I*PC1  J-PC8M 
1P(5)  >  STH 

GO  TO  10 
90X(J-3)  =  (P(2)-  P(i)-P(6)='P(5))-CTH:SPH+(P(3);P(  1)-P(7) 

1P(5) )   'STH 
10    CONTINUE 
RETURN 

END 
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SUBROUTINE    SHCAU P  , M,X,Uf N,NS,NL,ND,XS,KE,L I 

C    SUBROUTINE    SHCAL 

C 

C  PURPOSE 

C  TO    CALCULATE    THL    FORCES    AND    MOMENTS    ON    THE    DSRV    CAUSED 

C  dY    SHROUD    DEFLECTION    ANGLES 

C 

C  SLBPOUTINES    REQUIRED 

C  UTCCMt ASCOMiRGCCNtSIMQ 

C 

C  DESCRIPTION 

C  CHAPTER  03iMaNoHAYES  THES  IS ,MI T , 1971 , NAME  DEPARTMENT 

C 

C  '.'■■■ .-    ■:,■■];■                                                    ..  : 

DIMENSION  P(l) ,X(1) ,U(i> , XS(1) ,L(1 ) 

DIMENSION  A(18I,UT(3),FU(3) 

IF( (KBoLTo2)oANDo (L (1 )o EQ©4 ) ) GO  TO  1 

XSHR=P(M+47) 

CALL  UTCOM(U,N,XSHR,A) 

RAD-57o29577$5 
C     CALCULATE  U2S( I) 

VSQ=0, 

D3  2  1=1,3 

UT( I )-Oo 

00  3  K=1»KB 

J=L(K) 

MN=I+3*J-3 

UT( I )  =  UT( I )*A(MN)*X(J ) 
3  CJNTINUE 

VSQ=VSQ+UT<  I  )-'UT(  I  ! 
2  CONTINUE 
C     CALCULATE  SHROUD  ANGLE  ALPHA-S 

EPS  =  P{f^-50) 

CALL  ASCCM(UT,AS,IND,EPS,VNS) 

IF(AS3LT..Oo  J  A S=AS+3o  1415926  5 

AS=AS*RAD 
C      TEST  IND  AND  INCREMENT  A  SHROUD  RUN  PARAMETER 

I F ( I NDo  EQo 1 ) P ( M*5 1 ) =P i M  +5 1 ) +lo 
C     COMPUTE  LIFT  AND  DRAG  COEFFICIENTS 

CALL  RGCOM ( M , NL , P , IND, AS, CL ) 

MN=M+3*NL+1 

CALL  RGCOM(MN,ND,P, IND, AS , CD) 
C     COMPUTE  VLIFT  AND  VDRAG 

B  =  0o  5*  P(  M+49  N-VSQ-*P  (M  +  48  > 

VLIFT=B*Cl 

VDRAG=B*CD 
C     COMPUTE  VNF  AND  FU(1) 

AS=AS/RAD 

CAS=COS(AS) 

SAS=SIN(AS) 

VNF^VLIFT!;CAS  +  VDRAG:vSAS 

FU( 1 )  =  VL1FV?  SAS-VDRAG "CAS 
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TEST    VNS    FROM    ASCCK 

!F(VNSoEQoOq ) VNS=EPS 

FU(2)=-UT(2)     VNF/VNS 

FU(3)=-UT(3)*VNF/VNS 

SOLVE  SIMULTANEOUS  EQUATICNS  FOR  SHROUD  FORCES 

XS(1)=FU(1) 

XS( 2)-FU(2) 

XS(3)=FU(3) 

CALL  S I ivi Q  (  A ,  X S  ,  3  ,  I N 0  ) 

TEST  SIMQ  INDICATOR 

IF(  INDoEQoOJGG  TO  4 

WRITE(6,5) 

5  FORMATdX,  'SIMQ    IN    SHCAL    GIVEN    SINGULAR    SYSTEM') 
DO    6    K=lfKB 

KP=L(K) 
XS(KM)=0 

6  CONTINUE 
RETURN 

SELECT  AND  CALCULATE  MOMENTS 
4  DO  7  K=1,KB 

IF(L(K)cLTo5)GO  TO  7 

I  F ( L ( K  )o  EQo  5 )XS { 5 ) =X5HR*XS< 3 ) 

IF(L(K)cEQo6)XS(6)=-XSHR;XS(2) 

7  CONTINUE 
1  XS(4)=0o 

RETURN 
END 
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SUBROUT  I NE  RGCCM  [  M  » N , Pt  1 1  Xt  Yl 
C  .  •• 
C  SIBR3UTINE  RGCOM 

C 

C  PURPOSE 

C  TO  COMPUTE  A  LINEAR  VALUE  WITHIN  A  RANGE  GIVEN  STRAIGHT 

C  LINE  SLOPES  AND  INTERCEPTS 

C 

C    SL3R0UTINES    REQUIRED 

C        NCNE 

C 

C  DESCRIPTION 

C    SEE  SUBROUTINES  ShCAL  AND  TECAL 

C   CHAPTER  D3|MoNoHAYES  THESIS tMIT v 1971 » NAME  DEPARTMENT 

C 

C  ;  ■•  •   •    •  - 

DIMENSION  PQ  ) 

DO  1  K  =  1,N 

IF(XoGToP(N:  +  K)  )GO  TO  1 

I=K 

MV=M<-N+K 

Y  =  P(MV)::;X-i-P(MV  +  N) 

RETURN 
1  CONTINUE 

I=-l 

Y=Oo 

RETURN 

END 
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SUBROUTINE  ASCGM{UT,A,I,E  ,V  ) 

5U3ROUTINE  ASCOM 

PLPPOSE 

TO    COMPUTE    SHROUC    ANGLE    ALPHA-S 

S13ROITINES    REQUIRED 
NGNE 

DESCRIPTION 

SEE    SU3ROLTINE    SHCAL 

CHAPTER    D3,M0NoHAYES    THES  IS  ,M IT , 1971 .NAME    DEPARTMENT 

DIMENSION  UT(l) 

1=0 

TEST  UTI1I  FOR  ZERO 

IF(UT(l)o EGoOo )G0  TO  1 
2  V  =  SQRT(UT(2KUT(2)+UT(3):  LT(3)  ) 

A=ATAN(V/UT(1 ) ) 

RETURN 
1  UT(1)=E 

1=1 

GO  TO  2 

END 
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SUBROUTINE    UTCOM{UfN,XfAJ 

SUBROUTINE    UTCCM 

PURPOSE 

TO  COMPUTE  THE  DSRV  SHROUD  AijGLE  I R  AKSE  ORHATIOM  MATRIX 

SUBROUTINES  REQUIRED 
NCNE 

DESCRIPTICN 

SEE  SUBROUTINE  SHCAL 

ChAPTER  D3, Mo  No  HAYES  ThES  IS $ M  IT , 197 1 , NAME  DEPARTMENT 

.  I  ■  .  ■  ! 

DIMENSION  U(l ),A(1 ) 
CP-COS(U(N)) 

SP=SIN(U(N) ) 

CY=CCS(U(N+1) ) 

SY=SIN(U(N+1) ) 

AC1)=CY*CP 

A(2)=-SY-CP 

A(3)=SP 

A(4)=SY 

A(5)=CY 

A(6)=0o 

A(7)=-CYSP 

A(8>=SY*SP 

A(9)=CP 

A(10)=Oo 

A(ll)=Co 

A(12)=0c 

A(13)=X*A(7) 

A(14)=X- A( 6) 

A(15)=X  <A(9) 

AU6)=-X>A(4) 

Mi7)=-X  A(5) 

A(18)=-X: A(6) 

RETURN 

END 
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SUBRCUT  INE    PRCAU  P  ,  H  , X , U, N, NP  ,XP  ,  K  ) 

******  • .  :       .;■:...  .     .       .  .   •    .. . 

SUBROUTINE  PRCAL 

PURPOSE 

TO  CALCULATE  THE  FORCES  AND  KCMENTS  ON  THE  DSRV  CAUSED 
3Y  PROPELLOR  ROTATION  AND  RCTATIONAL  ACCELERATICN 

S13R0UTINES  REQUIRED 
NONE 

DESCRIPTION 

CHAPTER  D3fMoNohAYES  THES ISf MIT, 1971 , NAME  DEPARTMENT 


DIMENSION 
LOGICAL  A, 
PN=P(M+36) 
VP=X(2  l+PM*X(6) 
WP=X(3)-PM  X(5) 
GO  TO  (1,2, 3, A, 
SURGE  REGION  DE 

1  A  =  X(l)oGE=  03 
B=U(N)oGEc-Ou 

C  =  (U(N)-P(N«-35) 

PV=P(M+32):-U(N) 

IF(  A0ANC--C)  ISW= 

IF ( Ao ANCo »NOToC 

IF(oNCToAa  ANDoP 

IF(oN0To (AoORoB 

GO    TO    (7,8,9,10 

PROPELLOR  SURGE 

70XP  =  P(M  *U(N)*AB 

1P(M+2)*X(1 )  X(l 

RETURN 

30XP  =  P(  F+3)  >U(N)-;: 

1P(M*5)  ^X(l) ^Xti 

RETURN 

90XP=P(M 

lP(M+8) 

RETURN 

100XP=P(M 

1P(M+11 

RETURN 

SWAY  R 

2  IF(U(N 
PROPEL 
XP=P(M 
RETURN 

11  XP=P(M 
RETURN 
HEAVE 

3  IF(U(N 


'.:■..•.• 
P  (  1  )  ,  X  (  1  )  ,  U  (  1  ) 
EfC 


:X( 1)*X(1 

+9)*U(N)* 
l*Xm*X< 

EGIGN  DET 
LLToO,  )G 
LOR  SWAY 
+12)*U(N) 


5,6),K 

TERMINATION    AND    EQUATION    SELECTION 


•  X(l)  )oGE0Oo 

*»SQRT(  VP^VP  +  WP  -WP) 

1 

)ISW=2 

)ISW=3 

)  )ISW  =  4 

)  ,  ISW 

EQUATIONS 
S(U(N)  )+P(iv  +  l)  X(  1  )='U(N)  + 
)  +  PV 

ABS(UIN)  )+P(M+4)  -X(l>: -U(N)  + 
)  +  PV 

A3S(U(N)  )+P(N+7):X(  D-  U(N)  + 
)  +  PV 

A8S(U(N)  )+P( M+10 )  " X ( 1 ) *U (N I ♦ 
1)+PV 

ERMINATICN  AND  EQUATION  SELECTION 

0  TO  11 

EQUATIONS 

*VP 


+  13)  KJ(NI*VP 

REGICN  DETERMINATION  AND  EQUATION  SELECTION 
loLToOo  )G0  TO  12 
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XP=P(f-ui4)  :u(N)  •  wp 
RETURN 

12  XP=P(M+15)*U(N)*WP 

RETURN 

RCLL    REGION    DETERMINATION    AND    EQUATION   SELECTION 
t\    A=X(l)oGEoOo 
B=U(N).GEoO« 

C=  {  U  {  N  )  -P  (  M  +  3  5 )  ■■ X  ( 1 )  )  o  GEo  Oc 

PV=P (M+33  )  *U  (  N)  "'SQRT  (  VP*VP*WP  -'WP  ) 

PD=P(iv+34)-  UtNU) 

IF( AoANDcC) ISW=1 

IFCAoANCooNOToC ) ISW  =  2 

IF(oN0ToAoANDoB)ISW=3 

IFUNOTo  (  AoOR^B)  )ISW=4 

GO    TC     (13,14,15,16) , ISW 

PROPELLER  ROLL  EQUATIONS 

130XP=P<M+16)*U(N)*ABS(U(N))+P{M  +  17)*xm*U(N)  + 

IP  ( M+i  8 )  •-:  X  1 1  >*X  { 1  )  +  PV+  PD 
RETURN 
140X  P=  P  (  M  +  19  )  #U  (  N  )  *ABS  ( U  ( N  )  )  +P  (  M+2  0  )*X<  1 J  *U  (  N  >  + 
IP ( M  +  2 1 >*X(  1 ) ; :  X ( 1 ) +  P V+  PD 

RETURN 
150XP  =  P  (  M+22  )  *U(N )  ••  ABS  (U  (N  )  MP  (M+23  J  -  X  { 1  )  *U  ( N  )  + 

IP  (  M  +  24  ) ■:  X  (  1  )  ■  X  (  1  )  +  P V  +  PD 
RETURN 
16  0XP  =  P(M+25)::U(NHABS(U(N) )+P(M+26)  Xfl )  U(N)+ 
1P(M+27>*X(1)*X(  1H-PV+PD 

RETURN 

PITCH  REGICN  DETERMINATION  AND  EQUATION  SELECTION 

5  IF(U(N loLToOo  >G0  TO  17 
PROPELLOR  PITCH  EQUATIONS 
XP  =  P(M  +  28)?'-U(N)-WP 
RETURN 

1?  XP=P(M  +  29)^U(N);:-WP 
RETURN 
YAW  REGION  DETERMINATION  ANC  EQUATION  SELECTION 

6  IF(U(N)oLTo0o )GO  TO  18 
PROPELLOR  YAW  EQUATIONS 
XP  =  P(M  +  30)  ■: U(N);  VP 
RETURN 

13  XP=P(M+31)*U<NI*VP 
RETURN 

END 
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SUBROUTINE  THCALC P fM,U,N, X,XT,K) 

■  .  ■ 

SUBROUTINE  THCAL 

PURPOSE 

TC  CALCULATE  THE  FORCES  AND  MOMENTS  ON  THE  OSRV  CAUSED 
BY  THRUSTER  PRCPi;LLGR  ROTATIONS 

SLfiROUTINES  REQUIRED 
RGCOM 

DESCRIPTION 

CHAPTER  D3fM«>NoHAYES  THESIS,MITf 1971 , NAME  DEPARTMENT 

■    .    ■ 
STEADY  STATE  EQUATIONS  USED  FOR  THRUSTER  CALCULATIONS 
DIMENSION  P(U  ,U(1),N(1),X(1) 
GJ  TO  (1,2, 3, 4, 5, 6)  ,K 
THRUSTER  SURGE  EQUATIONS 

1  XT=Oc 
I=N(2)-1 
NT=N(1  ) 
JS  =  4 
JR=-1 
MV=M+60 

DJ  7  J=1,NT 
JS=JS-t  JR 
IJ=I+J 
JT=JS+2 
HV=MV+JR*10 
UI=ABS(U( IJ) ) 
IFtUloEQoOo 1GG  TO  16 
A=X(1)/UI 
PV=P (M+128J 
IF(A;GToPV)A=PV 
PW=P(M+127) 
IF(AoLT0PW)A=PW 

CALL  RGCGM(MV,N( JT),P,IR,A,TS) 
XT  =  XT  +  U( I  J)-U(  IJ)  TS 
li>  JR=-JR 
7  CONTINUE 
RETURN 
THRUSTER  SfcAY  EQUATIONS 

2  XT=Oo 
I=N(2)-1 
ISW  =  0 

JT  =  3 
MV*M 

PV=P(M+123) 
Pki-PCM+127) 
12    1*1+1 

UI=ABS(U(  I  )  ) 
IF(UI«€QoOo )GO    TO    17 
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A  =  X(1 
IF(Ao 
IF(A3 
CALL 
XT  =  XT 
17  MV=MV 
JT=JT 
ISW=I 
GO  TO 

13  RETUR 
C              THRUS 

3  XT=Oo 
I  =N  ( 2 
ISW  =  0 
JT  =  3 
MV=M 
PV  =  P( 
PW  =  P( 

14  1=1+1 
UI=AS 
I  F  (  UI 
A=X(1 
IF(Ao 
IF(Ao 
CALL 
XT=XT 

13  MV  =  MV 
JT=JT 
ISw=I 
GJ    TO 

15  RETUR 
C              THRIS 

\    XT=Oo 

RETUR 

C  THRLS 

5  XT=Oo 
I=N(2 
JV=M  + 
XT  =  XT 
1  =  1+1 
XT  =  XT 
ISW  =  0 
MV  =  M  + 
JT  =  7 
JV=M  + 
PV=P( 
PW  =  P( 

a  i=i+i 

UI  =  AB 
IFCUI 

A  =  X(1 
IF(Ao 
IF(Ao 


» /UI 

GT.jPV) 
LToPW) 
RGCOM( 

4  U  (  I   )  '• 

♦  25 

+  1 
SW+1 

(12,1 

N 

TER    HE 

)4I 


A=PW 

MV,N( JT) ,P, IR, A,TS) 

abs(U(  i ) )  ns 


3),ISW      . 

AVE  EQUATICNS 


M+128) 

M+12  7) 

S(U(  I  ) 

oEQcOo 

)/UI 

GToPV) 

LToPW) 

RGC0M( 

+U(1 ) * 

+  25 

+  1 

Stt+1 

(14f  1 
N 
TER    RO 


) 

)GC    TO    18 

A  =  PV 

A  =  PW 

MV,N(JT) ,P,IR,A,TS) 

ABS(U{  I  )  ) ■••  TS 


5)  ,  ISv; 

LL    ECUATIGNS 


N 

TER    PITCF    EQUATICNS 


) 

3.22 
+P( JV) 

:P(  JV)- 

76 

120 

M+128) 

M+127) 


*U(I )-ABS(U(I)  ) 
*U(I  )*-ABS(U(I  )  ) 


I 


S(U(I  ) 

0EQ0O0 )G0    TO    19 

)/UI 

GToPV) 

L  T„  P  VI ) 


A  =  PV 
A=PW 


-W 


19 


10 


20 


11 


CAL 

XT  = 

MV= 

JV  = 

JT  = 

ISW 

GO 

RET 

THP. 

X7  = 

I=N 

isw 

MV  = 
JT  = 
JV= 
PV= 
PW= 

1  =  1 

UI  = 

IF( 

A  =  X 

IF( 

IF( 

CAL 

XT  = 

MV= 

JV= 

JT  = 

ISW 

GO 

1=1 

XT  = 

1  =  1 

XT  = 

RET 

END 


L  R 
XT  + 
MV  + 
JV  + 
JT  + 
=  IS 
TO 
URN 
UST 

Oo 

(2) 

=  0 
M+7 
7 

M  +  l 
F(M 
P  (  M 
+  1 
ABS 
UI  o 
(1) 
AcG 
AoL 
L  R 
XT  + 
H  V  + 
JV  + 
JT-: 
=  IS 
TC 
+  i 
XT  + 
+  1 
XT  + 
URN 


GCOM(NV,N< JT),P,IR,A,TS) 

FIJVIvU!  I  )■  ABSClM  I)  )•  TS 

22 

1 

1 

W-5-1 

(8,9)  ,  ISW 

ER  YAW  EQUATIONS 

-1 

6 

23 

+  12  6) 

+  127) 

(U( I ) ) 

EQoO« )GO  TO  20 

/UI 

ToPV)A=PV 

ToPW)A=PW 

GCCM(MV,N(JT) ,P,IR,A,TS) 

PUVI*U(.I )  *ABS{U< I)  )  •  TS 

22 

1 

1 

W  +  l 

(10,11 ) , ISW 

P(JV)- U(I )*ABS(l( I) ) 

P(JV)-U(I )  :ABS(U( I)) 
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SU3R0UTINE    COCAL( P,M,X,XC,K) 
5U8RJUTINE    COCAL 

PURPOSE 

TO  SELECT  THE  CONSTANT  FORCES  AND  MOMENTS  TO  BE 
APPLIED  TO  THE  DSRV 

SUBROUTINES  REQUIRED 

NONE 

DESCRIPTION 

CHAPTER  D3,MoNoHAYES  THESI S , MI T , 1971 , NAME  DEPARTMENT 

DIMENSION  Pd)tX(l) 

MP=M+K-1 

GO  TO  (1,2,3,4,5,6) ,K 

1  XC=P(MP) 
RETURN 

2  XC=P(MP) 
RETURN 

3  XC=P(KPI 
RETURN 

4  XC=P(MP) 
RETIRN 

5  XC=P(MP) 
RETURN 

6  XC=F (MP) 
RETURN 
END 
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SUBROUTINE    XDISTC  I  ,  P  ,  [•'.,  X  ,  K  ,  N) 

SUBROUTINE    XDIST 

PlPPOSE 

TO  CCMPUTE  A  VECTOR  OF  GAUSSIAN  RANDCM  NUMBERS 

SLBROUTINES  REQUIRED 
GAUSS( IBM/SSP) 

DESCRIPTION 

CHAPTER  D3fMoNoHAYES  ThES  IS , M  IT , 1973  , NAME  DEPARTMENT 

DIMENSION  I(1)»P(1) 
I X= I (K) 

MV=M+K-1 

AF=P(MV) 

PV=MV+N 

S  =  P  (  F  V  ) 

CALL  GAUSS ( IX,S,AK,X) 

RETURN  ^ 

END 


I(K)  «  IX 
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APPENDIX  A8 

CHAPTER  D5  SUBROUTINES   (OVDEfi,    GRADIENT) 

SUBROUTINE    OVDER( ME ,U , AV , XF, KF,LFfKB, Lf X,KP, LPtP, F, NF,NE I 

C  '  ..-...,...  .  .  .  .  . 

C  SUBROUTINE  CVDER 

C 

C  PURPOSE 

C    TC  COMPUTE  SELECTED  STATE  DERIVATIVES  WITH  RESPECT  TO 

C   SECOND-DEGREE  COEFFICIENTS  AND  PARAMETERS  FOR  A 

C   GENERAL  OCEAN  VEHICLE 

C 

C  SUBROUTINES    REQUIRED 

C         TANKS,ACALC,A3INV,MINV,XDDER,SEDfcR,PRDER,THDER,  SHDER, 
C         XFDER,XPDER 

C 

C    CESCRIPTICN 

C        CHAPTER    D5,MoNcHAYES    ThES IS , MIT , 1971 , NAME    DEPARTMENT 

C 

INTEGER  AV,XF 

DIMENSION  .YE(  3.)  ,U(1)  ,NE  ( 1 ) ,  AV(  1 )  ,  XF  ( 1  ),LFO.)  ,L(  1)  ,X(1) 

DIMENSION  LP(1),P(1),F(1) 

DIMENSION    A (36) , ATH( 9 ) , NT ( 14 ) ,MM (6 ) ,PG ( 8 ) ,PC(8)  ,XD(36) 

DIMENSION    XS(36) ,XFD(756) ,XPD(756) 

MT=ME(17)-1 

DO    5    KT=1,S 

PG(KT)=P(MT+KT) 

5  CONTINUE 
IF(ME(I)oNEol )GO    TO    1 

CALL    TANKS(P,ME(10),U,NE(1),PG) 

1  MG=ME( 18) +1 
G=P(MG) 

CALL    ACALC(P,PG,G,A,KB,L) 
C  BEGIN    INVERSION    OF    A 

IFUBoNEcl  )GO    TO    2 
IF(A(1)  oEQoOo  >GO    TO    3 
A(l)=l*/A(l) 
GO    TO    8 

2  IF(KBoNE,2)GO    TO    4 
DET=A(ir A(4)-A(2) v A(3) 
IF(DEToEQ..0.  )GO    TO    3 
DET=lo/DET 

AH---A(I) 

A(1)=A(4)-DET 

AC2)=-A(2)*DET 

AC3)=-A(3) iDET 

A(4)=AH^DET 

GO    TO    8 
4    IF(KBoNEo3)GO    TO    6 

DO    7    K=l,9 

ATH(K)=A(K) 
7    CONTINUE 

CALL    A3INV(ATH,A> 

GO    TO    8 

6  CALL    MINV(A,KB,DEl ,NT,MM) 
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IF(DET»EQoOo  )GG    TO    3 

GO  TO  8 
3    IKB=KB*KB 

D3    9    K=lf 1KB 

A(K|=C3 
9   CONTINUE 

WRITE(6,i0) 

10    FORMATUX,  'SINGULAR    DETERMINANT    IN    OVDER,    SETTING    F=0o  •  ) 

GO    TO    1.1 
3    NC=ME(18) 

PC\I )=PG(1 J/PCNC+1 ) 

PC(2)=PG<21 

PC(3)=PG(3> 

PC(4)=PG(4) 

PC(5)=PC37 ) 

PC(6)=P(39) 

PC(7)=P<42) 

PC(8)=P(43) 

NT<1)=NE<4) 

NT<2)=NE(9) 

DO  34  1=3,8 

NT( I )=NE{ I +10) 

NT( I+6)=NE( 1+19) 
34  CONTINUE 

DJ  12  KM=1,KB 

K=L(KK  ) 

DO  13  KN=i,K8 

N=L(KN1 

NF  =  ;;-;- 6  ;(K-l) 

Dx=o, 

CALL  XDDER( AVf XFf P f PCt X ,DXt K f Mf KB f L I 

IF(ME(2)oNEol  )G0  TO  14 

CALL  SEDERCPfME(ll) ,X,DXS,NF) 

0X=DX+CXS 

14  IF(ME(4)oNEol )GG  TO  15 

CALL  PRDER(PfME(13) , X, U, NE( 8 )  , NE ( 3  )  ,DXP , NF ) 
DX=DX+CXP 

15  IF(ME(5)oNEol )G0  TO  33 

CALL  THDER ( P , ME ( 14  )  t  U ,NT , X , DXT, NF ) 

DX  =  DX-:-DXT 
33  XD(NF1«DX 
13  CONTINUE 
12  CONTINUE 

IF(ME(3)oNEol)G0  TO  16 
OCALL  SHDER(P,ME(i2)jX,U,NE(7) ,NE(2),NE(11) ,NE(12) , 

1N5(20) ,NE(21 ) ,XS,KB,L> 
NV=1 

DO  17  KM-ltKB 
K=L(KM) 
DO  18  KN=1,KB 
M=L(KN) 
NF=M*6*(K-1) 
F(NV)=XD(NF)+XS(NF) 
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NV=NV+1 

18  CONTINUE 
17  CONTINUE 

16  IF(ME(3)oEQol)GO  TO  19 

NV=1 

D3  20  KM=lfKB 

K=L(KM) 

DO  21  KN=1,KB 

N=L(KN) 

NF=M+6*(K-1) 

F(NV)=XC(NF) 

NV=NV+1 
21  CONTINUE 
23  CONTINUE 

19  IF(KFoEQoO)GO    TO    24 

CALL  XFDEK(AV,XF,PfPC,XtXFD,KFiLFfK8f L,ME(il) ) 

ND=0 

NL  =  1 

N3=NV-1 

DO  23  KM=lfKB 

N=L(KM) 

DO  35  JM=lfKB 

J=L{ JM) 

DO  36  IM=1,JM 

I=L( IM) 

I  JM*I+<  J*  (  J-l  )  )  /2  +  21>:  (  M-l  ) 
3  3  IF(NLoGToKF)GO  TO  37 

IF(LF(NUoGT»IJM)GC  TO  36 

IF(LF(NL)oEQo IJMJGO  TO  39 

NL=NL+1 

GO  TO  38 
29  ND=ND+1 

DO  22  KN=1,KB 

K  =  L(KM 

IJK  =  K+6-:(I  JM-1) 

NK=N8  +  KN  +  KB  -(ND-1) 

F(NK)=XFD(  UK) 

CONTINUE 

NL=NL+1 

CONTINUE 

CONTINUE 

CONTINUE 

NV=NV+KB  ND 

IF(KPoEQ;,0)GC)  TO  25 

CALL  XPDER(P,ME,U,NE,X,XPD,KP,LP,K8,L,NT) 

DO  26  KM=1,KP 
K=LP(KM) 
DO  27  KN=1,KB 
M=L(KN) 
NF=M+6*<K-1 ) 
F(NV)=XPD(NF) 
NV=NV+1 
27  CONTINUE 
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21 

36 
25 
23 
27 
24 


26 


25 


23 


31 

30 
29 

11 


32 


CONTINUE 

BEGIN  DERIVATIVE  TRANSFORMATION 

IR  =  G 

IK  =  0 

NF=KB+KF+KP 

DO  29  K=1,NF 

DO  28  KM=1,KB 

IK=IK+1 

PG(KM)=F( IK) 

CONTINUE 

DO  30  H=1,KB 

IR=IR+1 

JI=K-KB 

IB  =  0 

F( IR)=Oo 

DO  31  1=1, KB 

JI=JI+KB 

I3=IB+1 

F( IR)=F( IR)+A(JI) >PG(  IB) 

CONTINUE 

CONTINUE 

CONTINUE 

RETURN 

NF=KB+KF+KP 

IKB  =  KB:'  NF 

DO  32  K=l, 1KB 

F(K)=Oc 

CONTINUE 

RETURN 

END 
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SUBROUTINE  XDDER ( AV, XF, P, PC, X ,DX, K ,M,  KB,  L ) 

C  ■.  :  .  -::  ■••■   ■  ■  •  •'•'•  +* 

C  SU3R0UTINE  XDDER 

C 

C  PURPOSE 

C    TO  COMPUTE  THE  STATE  DERIVATIVES  OF  THE  SECCND-DEGRE6 

C    COEFFICIENT-FUNCTIONS  Or    AN  OCEAN  VEHICLE 

C 

C  SL3ROUTINES  REQUIRED 

C    XFUNS 

C 

C   DESCRIPTION 

C         CHAPTER    D5,MDNuHAYES    THES  IS , MIT , 1971 , NAME    DEPARTMENT 

C 

INTEGER    AV,XF 

DIMENSION    AV ( 1 )  ,  X F ( 1 ) , P ( 1  ) , PC ( 1 ) ; X ( 1 )  , L  ( 1 ! 

DX  =  Oo 

DO    1     IN-l.KB 

I  =L  (  I  M  ) 

DO    2    JM=IMtKB 

J=L( JM) 

I  JK  =  H  (J*(  J-l))/2  +  21-MK~l) 

IF(XF(  [JK)oEQoO)GQ    TO    2 

IF(  (  IoNEcMloAND^  (  JoNE.M)  )  GO    TO    2 

KIJ=IJK+6 

CALL    XFUNS(PCX,KIJfXCXF) 

IF(IoEQ,J)GO    TO    3 

IF(  IoEQoMJGO  TO  4 

IF(AV(  UK)  )5,6,7 

5  DX=DX+ABS(X( I ) »*XC 
GO  TO  2 

6  DX=DX+X(I  )  -;XC 
GD  TO  2 

7  DX=DX+X(  1  )  '  SIGN(lo  iX(.J)  )  XC 
GO  TO  2 

4  IF(AV(  IJ.U  )10,11,12 

10  DX=DX+X(  J  p.  SIGN  do  tX(I))*XC 
GO  TO  2 

11  DX=DX+XCJ)*XC 
GO  TO  2 

12  DX=DX+ABS(X(J)  );  XC 

GO  TO  2 
3  IF(AVUJK)  )8,9,3 
3  DX=DX+280*ABS(X(in*XC 

GO  TO  2 
9  DX=*DX*2oO*XU  »*XC 
2  CONTINUE 
1  CONTINUE 
RETURN 
END 
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SUBROUTINE  SEDER ( P ,M, X , DXS, K) 

SUBROUTINE:  SEDER 

PURPOSE 

TO  COMPUTE  THE  STATE  DERIVATIVES  OF  THE  SECONDARY  DRAG 
TERMS  FOR  THE  DSRV 

SUBROUTINES  REQUIRED 
NCNE 

DESCRIPTION 

CHAPTER  D6,M>i\L.  HAYES  THESIS, MITf  1971  ,  NAME  DEPARTMENT 

DIMENSION  PC.  >,X(1) 
OGO  TC  (1,1,1,1,1,1,1,2,1, 1,  1,8, 1,1,4,  1,6, 1,1,  1, J ,1,1, 
11, 1, 1, 5 , 1,7, 1,1, 3, 1,1,1, 9), K 

1  DXS=Oo 
RETURN 

2  TA=X(2)+P(MH30) JX(6) 
TB=X(2)+P(M+29)*Xi6) 
XC=X(30) 

IF(X(6)  )27, 26,26 

26  IF( (TAoGEoOo )oORo (TBoLEoOo ) )GO    TO    28 
ISW=2 

GO    TO    29 

27  IF<  (TAoLE»Oo»oOR«ITBaGEo04,})GO   TO    28 
ISW=2 

GO    TC    29 
23    ISW=1 

29  GO    TO    (10,11) ,  ISW 

3  TA=X(2)*P(M+30)*X(6) 
TB=X(2)+P(M+29)-X(6) 
XC=X(30) 
IF(X(6))31,30,30 

30  IF((TA.GEoOo)oORo(TB«LE.Oo) )G0    TO    32 
ISW=2 

GO    TC    33 

31  IF( (TA2LE,0, )3QRj (TB^GEoO^ ) )G0    TO    32 
ISW-2 

GO    TC    33 
3  2    ISW=1 

33  GO    TO    (12,13)  ,ISW 

4  TA=X(3)-P(M+3CH<X(5) 
TB=X(3)-P(M+29)-<X(5) 
XC=X(54) 

IF(X(5)  ) 35, 34,34 

34  IFUTAoLEoOj  )0ORy  (TBoGEoOaMGG    TO    36 

ISW=2 
GO    TO    37 

35  IF(  (TAoGEoOo  )oORo  (TB^LEoO.)  )G0    TO    36 

ISW  =  2 
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GO    TO    37 

36  ISW-1 

37  GO    TO    (14, 

5  TA=X(3)-P( 
T8^X(3)-P( 
XC=X(54) 
IF(X(5)  )39 

33    IFUTAoLEo 
ISW  =  2 
GO    TO    41 

39  IFMTAoGEo 
ISW=2 

GO    TO    41 

40  ISW=i 

41  GO    70    (16, 

6  TA=X(3)-P( 
TB=X(3)-P( 
XC=X(54) 
IF(X(5))43 

42  IFUTAcLEo 
ISW=2 

GO    TO    45 

43  IFMTAcGEo 

GO  TO  45 

44  ISW=1 

4  5  GO  TO  (18, 

7  TA-xm-pi 

TB=X(3)-P( 
XC=X(54) 
IF(X(5! )47 

46  IF( (TAoLEo 
ISW- 2 
GO  TO  49 

4  7    IF((TAoGEo 
ISW  =  2 
GO    TO    49 

4  3    ISW=1 

49  GJ    TO    (20, 
3    TA=X(2)+P( 

T8*X(2)+P( 

XC^X(30) 

IF(X(6))5i 

50  IFUTAoGEo 
ISW  =  2 

GO    TO    53 

51  IF((TA3LEo 
ISW  =  2 

GO    TO    53 

5  2    ISW=1 

5  3    GO    TO    (22, 

9    TA=X(2HP( 

TB=X(2)+P( 


15)   y  ISW 

M  +  30)    X 
M  +  29P-X 

,38,38 
Oo  k-ORa 


(5) 
(5) 


(TBoGEoOo  )  )GO    TO    40 
0,  )  )OR,  (TBoLEoOo  )  )G0    TO    40 


17)  -ISW 
M+30)  X 
M+29)     X 

»42, 42 

0     )  ,>0Ro 


(5) 
(5) 


(TBoGEoOo  )  )G0   TO    44 


0,  )oORy  (TBoLEoOo  )  )G0    TO    44 


19) , ISW 

M  +  30)    X 

M+2  9)     X 

,46,46 
Oo  IcORo 


(5) 
(5) 


(TBoGEoOc ) )G0    TO    48 
Oj  )  jOR^tTBoLEoOo  )  )G0    TO    48 


21 )  ,ISW 

M+30)  :  x 
M+2  9)     X 

,50,50 
Oo ) oORo 


(6) 
(6) 


(TBoLEoOo I )G0    TO    52 
0.- )oORo  (TBoGEoOo  )  )GC    TO    52 


23), ISW 
M+30) :x 

M+2  9)     X 


(6) 

(6) 


XC=X(30) 

IF  (X  (6)  15)5,54,54 

54  IF(  (TAcGEoOo  )-.0R3(TBjLEo0oMG0    TO    56 
ISW^2 

GO    TG    57 

55  IF(  (TAoLEoOo  )oOR9(TBeGEoOoMGO    TO    56 
ISW=2 

GO    TO    57 

56  ISW=1 

57  GO    TO    (24,25) ,ISW 

10    DXS=P(M)*2oO*ABS(X(2l »+P(M+l)*X(6)*SI GN( 1„ ,X(2) ) 

DXS=DXS -XC 

RETURN 
1 iODXS=P ( M+3 ) *S IGN( lo iX(6) )*3o 0*X< 2 )-:X ( 2 ) /X(  6  )  +P  (M+4  ) 
ISIGNUo  ,X(6)  »*2«0*X(2  !+P{f><-5)  *ABS(X(6  )  ) 

0XS=DXS-XG 

RETURN 

12  DXS=P (  M+l  )*ABS  (  X  (  2  )  )  +P  (  M+2  )  ;  S  IGN  <  lo  ,  X  (  2  M  *2o  0 -.  X  (  6 ) 
DXS  =  DXS-:XC 

RETURN 
130DXS=P(M+3K-SIGN(1„  ,X(6))(X(2)/X(6)  ) -:■  (X(2)/X(6)  ) -■ 

1(-X(2}  )+P(M+5)*X{2)*SIGN(  le  ,X  (  6  )  )  +P  (M+6  )    -2e  0  •  ABS  (  X  (  6  )  ) 

DXS-OXS*XC 

RETURN 
14    DXS-PCM+7)*2o  0' ABS(X( 3)  )  *P(M+8H  XC5M  SIGN(1.,X(3J  ) 

DX5=DXS*XC 

RETURN 
1500XS=P(  M*  i  0  )     S  I GN  ( 1=  ,  X  (  5  )  )  •  3  -,  0    X  (  3  )  i  X (  3  )  / X  (  5  )  +  P  (  M*  1 1  I 
1 S I GN  I  lo  ,  X  (  5  )  )    2 ,  0 •:  X  (  3  )  +  P  (  M+12  )  -ABS  (  X(  5  )  ) 

DXS---DXS'XC 

RETURN 
16    DXS=P(M+    8)*ABS(X(3) )  *P(M+9  »*SIGN(  lo  ,  X(3 )  )*2«  0*X(  5 ) 

CXS=DXS-XC 

RETURN 
1700XS=P(M+10)-  SIGN  do  ,  X ( 5 ) ) ^ ( X( 3 ) /X { 5  )  >     (  X ( 3 ) /X ( 5 ) )     ( - 
1X(3)  )  +  P(M+12):  X(3)     SIGNdo  ,X(  5)  )  *P  (  M+13  )  *2«  0  •  ABS  (  X  (  5  )  ) 

DXS=DXS*XC 

RETURN 

13  0XS=P(M+18)-.SIGN(1,  ,X(3)  )*X(5  )+P  (M+19)*2«,0*ABS«  X(3)  ) 
DXS=CXS-XC 

RETURN 
1  90DXS-  P  {  M-J-l  5  )  :  S I  GN  i  lo  ,  X  (  5  )  )  ••  2^  0- X  (  3 )  +P(  M+16  )*SI  GN ( 1.  • 
IX (5) »*4e0*(X(3)**3o  »/(X(5)*X(5J  )*P(M+17 )* ABSl XC 51 1 

DXS  =  DXS-  XC 

R  E  T  U  R  f 
20    DXS=P(M+181*ABS(X(3)  )  ♦P(M*20I*SIGN(1,  ,X(3)  l*2*0*X(5) 

DXS  =  DXS::XC 

RETURN 
2iODXS  =  P(M+14)-2cO--ABS(X(5)  )  *P(M+16  )*SIGN<1.  ,X(5)1*2«  0  (  ( 
1X(3)/X(5)  )**3o  )*(-X<3)  |+P(M+17)*SIGNCL«  ,X(5)  )  X(3> 

DXS=DXS  XC 

RETURN 
22  DXS=PCM+25)*SIGN<U,X<2n*X(6)*P<M+26l*2«0*ABStX(2)l 


DXS  =  DXS;;XC 
•RETURN 
230DXS»P(M+22l*SIGNl  13 ,X(6)  )*2oO*X(2)+PC  M+23M  SIGNCloi 
1X(6)  )*4a0*< (X(2J/X(6) »**2     )*X(2 ) +P(M+24)*ABS(X<  6)  ) 
DXS=DXS  :XC 
RETURN 
24    DXS=P{M«-2  5)-:A3$(Xl2)  ) +P(M*27)*SIGN(li  »X(2)  )  l*2oO*X<6l 
DXS=CXS-  XC 
RETURN 
250DXS=P{M+21)*2oO*ABS(X(6)  J  ♦P(M*23)*SIGN(1«  ,X(6)  1*2.0    (  ( 
1X(2)/X(6)  )       3.,  »*(-X(2)  )+P(M+24)*SIGN<  1,  ,X(6)  )     X(2) 
DXS=DXSvXC 
RETURN 
END 
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SUBROUTINE    XFDER( AV,XF, P, PC ,X, XFD, KF , LF , KB , L , MS ) 

■  •  ■  ... 

SUBROUTINE    XFDER 

PURPOSE 

TO    COMPUTE    THE    DERIVATIVES    WITH    RESo    TO    SECCND-DEGREE 
COEFFICIENT    FUNCTIONS    FOR    AN    OCEAN    VEHICLE 

SUBROUTINES  REQUIRED 
XDFNS,SECAL 

DESCRIPTION 

SEE  SUBROUTINE  CVDER 

CHAPTER    D5,MaNoHAYES    THES IS, MIT, 1971 , NAME    DEPARTMENT 

f.    f  ■ 

INTEGER  AV,XF 

DIMENSION  AV(  1)  ,XF(1  )  ,P(1  )  ,  PC  {  i  )  ,X(1)  ,XFD( 1) , LF ( 1 ) ,L( 1 1 

NL  =  1 

DO  4  KN=1,KB 

K=--L(KN) 

03  1  KF=i,KB 

K=L(KM) 

DO  2  JN=1,KB 

J=L(JM) 

DO  3  I.M  =  ItJM 

I=L(IMI 

I  JM  =  H(  J-  U-l  )  )/2  +  21  *<M-1  ) 
li    IF(NLoGTcKFIGO    TO    8 

IF(LF(NL)oGTo IJM)GC    TO    3 

IF(LF(NL)  ,EQ.:  1JMJG0   TC    12 

NL=NL+1 

GO    TO    11 
12    IF(KoN£oM)GO    TO    10 

IF(XF( IJMJoEQoOJGG    TO   10 

NL=NL+1 

KIJ=I JM+6 

CALL    XDFNS(PC,X,KIJ,XF,DX,IND) 

KIJ-IJM 

IJP*K+6*( IJM-1) 

IF(  INDoEQ.,  0)G0    TO    9 

IF(AVCKIJ) )5i6f7 

5  XFD(IJM)  =  0X-:A8S(X(I  )  »*X(  J) 
GO    TO    3 

6  XFDUJM)  =  DXfX<  I  )*X(J) 
GO    TO    3 

7  XFD( IJMJ=DX*X( I )*ABS(X( J)  ) 
GO    TO    3 

10    IJM=K+6*(IJM-1I 
NYV=24 

IF(LF(NL)3EQoNYV)GO    TC    13 
NZW=48 
IF(LF(NL)oEQoNZW)GO   TO    14 
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14 

3 
2 

1 

3 
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NL=NL+1 
XFC(IJM)=Oo 

GO  TO  3 

CALL  SECAL( P,MS,Xf XS,K, XSU, XST) 

XFD( IJM)=XSO 

GO  TO  3 

CALL  SECAHPf MStXfXStKt XSOtXSTl 

XFD( I JM)=XST 

CONTINUE 

CONTINUE 

CONTINUE 

NL  =  1 

CONTINUE 

RETURN 

END 
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SUBROUTINE  XDFNS ( P  ,  X , K  , I , D , M 

C  : 

C  SUBROUTINE  XDFNS 

C 

C  PURPOSE 

C  TO  SELECT  AND  SUPPLY  THE  DERIVATIVES  WITH  RESo  TO  DSRV 

C  SECCND-DEGREE  COEFFICIENTS  FOR  SUBROUTINE  XFDER 

C 

C  SUBROUTINES  REQUIRED 

C  NONE 

C 

C  DESCRIPTION 

C  SEE  SUBROUTINE  XFDER 

C  CHAPTER  05f  M-jN^HAYES  THES  ISf  M  IT,  1971 , NAME  DEPARTMENT 

C 

DIMENSION  P(l  ),X(1  ), I (1 ) 

ISW=I(K-6) 
OGJ  TO  (2,l,2,2,2t2,2,l,2,3,l,l,2,2,3,l,2,l,l,2,l,3,2i 
12,3, 1,2,2,2,1,2,3,1,2,2,4,5), ISH 

1  D=Oo 
N  =  0 
RETURN 

2  D=l3 
N=l 
RETURN 

3  D=SIGN<1;,  ,X(1  )  } 
N  =  .l 

RETURN 

4  IF  (X(3)oLTo0o  )GO  TO  6 
N-l 

D  =  lo 
RETURN 

6  D  =  0:> 

N  =  0 
RETURN 

5  IF(X(l)oLToOo )GG  TO  7 

IF( (X(2)-P(8)  *X(1I  UGTaO*  )GO  TO  6 

N  =  l 
D  =  lo 
RETURN 

7  IF(  IX  (2  HP  (8)  X(l  )  icLToOo  )GO  TO  6 
N-l 

D=lo 

RETURN 

END 
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SUBROUTINE  XPDER{P,ME,U,NE,X,XPD,KP,LP,KB,L,NT> 
SUBROUTINE  XPDER 

PLRPOSE 

TO  COMPUTE  The  DERIVATIVES  WITH  RESo  TO  VEHICLE  AND 
EFFECTOR  PARAMETERS  FOR  AN  CCEAN  VEHICLE 

SUBROUTINES  REQUIRED 
SEDEPtPRDEP,THDEP 

DESCRIPTION 

SEE  SUBROUTINE  CVDER 

CHAPTER  D5fMoNoHAYES  THES IS , MIT , 1971 , NAME  DEPARTMENT 

DIMENSION  P(l)  ,ME(  1)  ,U(i)  ,NE(  1)  ,X(1),XPD(jL)  ,LP(  1)  ,L(1) 

DItfENSICN  NT(1) 

KME  =  9 

KMP=9 

DO  1  JN=1,KP 

J=LF(JF) 

KJ=KME 

IS  =  1 

DO  3  KM=1,KMP 

KJ=KJ+1 

IF(JoLToME(KJ) )GO  TO  4   - 

I S=IS : 1 

3  CONTINUE 

4  DO  2  If'  =  l,KB 
I  =L  (  I M  ) 
N=I+6^  (J-l) 

GD  TO  (5,6,7,8,9,10,11,12,13,14) , IS 

5  XPC(N)=0; 
GC  TO  2 

5  XPC(N)=(L 

GO  TO  2 
7  CALL  SEDEP(P,ME(li),X,PX,  I, J) 

XPD(N) =PX 

GO  TO  2 
3  XPD(N)*0« 

GO  TO  2 
9  CALL  PRDEP(P,ME(53),X,U,NE(8),NE(3),XP,I,J) 

XPD(N)=XP 
GO  TO  2 

10  CALL  THDEP(P,ME(14),U,NT, X,XT,I,  J) 

XPD(N)=XT 
GO  TO  2 

11  XPD(N)=C:> 

GO  TO  2 

12  XPC(N)=lo 
GO  TO  2 

13  XPC(N)-Oo 
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GO  TC  2 
XPO(N)=Oo 

CONTINUE 
CONTINUE 
RETURN 
END 
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SUBROUTINE  SEDEPCP, M, X, XSf Kf J  I 

..'■■.'  : ■•'  .  ,       .. 

SUBROUTINE  SEDEP 

PURPOSE 

FO  COMPUTE  THE  DERIVATIVES  WITH  RESo  TO  DSRV  SECONCARY 
DRAG  PARAMETERS 

SL3RCUTINES  REQUIRED 

NONE 

DESCRIPTION 

CHAPTER  D6fMoN©HAYES  THESIS, MIT ,1971 , NAME  DEPARTMENT 

t'.  *".':■  . 

DIMENSION  P(i),X(l) 

INITIAL  SECONDARY  DRAG  REGION  DETERMINATION 

IF(  (KoEQ-il)oOR*  (K0EQo4)  )GC  TO  1 

KM=8-K 

IF(  (KoEQc2)oORo  (K„EQ^6)  )  I  SW  =  1 

IF( (KoEQ:3),ORo(K- EQo5) )ISW=2 

GO    TO    (2,3)  ,ISW 

K=2    OR    K=6    REGION    DETERMINATION 

2  TA=X(2)+P(H+30)-X(6) 
TB=X(2)+P(M+2  9)  <X(6) 
XC=X(30) 
IF(X(6))17,16,16 

16  IF(  (TAoGEoCo  )oORo  (TBoLEoOo  )  )GJ    TO    4 
ISW=2 

GO    TO    5 

17  IF( (TAoLEoOo )oORo (TBoGEoOc )>GO    TO    4 
ISW=2 

GO    TO    5 

4  ISW=1 

5  GO    TO     (8,9) , ISM 
1    XS=0o 

RETURN 

K=3    OR    K=5    REGION    DETERMINATION 

3  TA=X(3)-P(M+30)*X(5) 
TB=X(3)-P( M+29)*X(5) 
XC=X(54) 
IF(X(5))19,18,18 

13    IF(  (TAoLE.Oo  >oORo  (TBoGEoOo ) )GG    TO    6 

ISW  =  2 
GO    TO    7 
19    IF(  ( TAoGEoOo )oORo (TBoLEoOo ) )GO   TO    6 

ISW  =  2 
GO    TO    7 

6  ISW=1 

7  GO    TO    (10,11  I ,ISW 

BEGIN    SELECTED    SECONDARY    DR/G    CALCULATIONS 

8  IF(KoEQo2)G0    TO    14 
K=5    OR    K  =  6    REGION    ONE 


12  N*M*19+(K-5>*7 

IF(JoMEc,N)GO  TO  20 
XS=ABS(X(KM) »*XCKM)*XC 
RETURN 
2  0  N=N-1 

IF(  JoN£foN)GO  TG  21 
XS=ABS(X(KM)  )•  X(K):  XC 
RETURN 

21  N=N+2 
IF(JoNEoN)GO  TO  1 

XS  =  SIGMlo»X(Kf)  )  X(K) -X(K)  vXC 
RETURN 
9  IF{KcEQo2)GO  TO  15 
K=5  OR  K=6  REGION  TWO 

13  N-M+14+(K-5)>i  7 
IF<JoNE«N)GC  TO  12 
XS=X(K»*ABS(X(KI );XC 
RETURN 

22  N  =  N+1 
IF(JoNEoN)GO  TO  23 
XS*SIGN(lo tX(K) )*X(K)*X(K)*XC 
RETURN 

21    N=N+1 

IF(JuNEoN)GO    TO    24 

X  S=  S I  G N  ( .1  o  ,  X  {  K  )  )  -.-X  (  K )  *X  IK )*  (  (X(  KM )/X  (  K)  )**2.  )  *XC 

RETURN 
2+    N=N*1 

IF(JoNEoN)GO    TO    1 

XS=X(KM) !=ABS(X(K) )*XC 

RETURN 

10  IF(K«EQo5)G0  TO  12 
K=2  OR  K=3  REGION  CNE 

14  K=M+(K-2)  7 
IF(JoNEoN)GO  TO  2  5 
XS=X(K)*ABS(X (K) )  -XC 
RETURN 

2  5  N=N  +  1 

IF(JoNEoN)GO    TO    26 
XS=X(KM)  ■>  ABS(  X(KI  >*XC 
RETURN 

26  N  =  N  +  1 
IF(JoNEoN)GO    TO    1 

XS  =  SIGN(lc ,XCK1)*X(KM)*X(KMH  XC 
RETURN 

11  IF(K5EQc5)GO    TO    13 
K=2    OR    K=3    REGION    TWO 

15  N*M+3+(K-2)*7 
IF(JoNEoN)GO    TO    27 

XS=SIGN(lo ,X(KM) »*X(K)*X«KI*CX(KI/X(KMJ l*XC 
RETURN 

27  N=N+1 
IF(JoNEoN)GO    TO    28 
XS=SIGN(lo ,X(KM) >    X(K) *X(K)*XC 


RETURN 

23  -.N  =  N+1 

IFt JoNEoNJGO  TO  2  9 

XS=ABS(X(KM)  )■  X(K)  :-XC 
RETURN 
29  N  =  N+1 

IF(JoNEoN)G0    TO    1 
XS=ABS<X(KM) )*X(KM»*XC 
RETI 
END 
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SUBROUTINE  A3INV( A,AI  ) 
*********     .■'.. 

SUBROUTINE  A3INV 

PURPOSE 

INVERT  A  GENERAL,  NCNSINGULAR  3X3  MATRIX 

USAGE 

CALL  A3INV( A, AI ) 

DESCRIPTION  OF  PARAMETERS 

A   -  GENERAL, NCNSINGULAR  3X3  MATRIX  IN 

VECTOR  FORM 
AI  -  INVERSE  OF  A 

REMARKS 

111-  THE  ZERO  VALUE  FOR  THE  DETERMINANT  HAS 

BEEN  ARBITRARILY  SET  AT  lo OE-40 
(2)-  AI  WILL  BE  SET  ZlRO  FOR  SINGULAR  MATRICES 

SUBROUTINES  AND  FUNCTION  SUBPROGRAMS  REQUIRtC 
NONE 

AUThCR 

MICHAEL  No  HAYES, RMc 5-333, KIT  X6807 

■  !  :****g  H- :•;--••  ^:-  ■■       ■-     !*****:  '  \  '  .  I  - 

DIMENSION  All  ),  Aid  ) 
30F0RMATUH1,  'MATRIX  A  IS  SINGULAR,  DET  { Ai  =  • ,  E15c  7  , 
l1    SETTING  AI  =  C\,  OM 

CCKPUTE  THE  DETERMINANT 
ODET  =  A  ( I )  *  (  A (  5 )  ■ A ( 9 ) -A  (6  )  *  A  ( 8)  )-A  ( 2  )*(  A  (4  J  *A  ( 9  )  - 
1A(6)*A(7J ) +A{ 3)*(A(4)*A18)-A(5)*A(7) ) 
TEST  DETERMINANT  FOR  ZERC 
IF (ABS(DET)-lcCE-4 0)1,2,2 
i  WRITE(6,3)CET 
DO  4  1=1,9 
Aid  >  =  0„0 
4  CONTINUE 
RETURN 

MATRIX  NONSINGULAR,  COMPUTE  INVERSE 

2  DET=lc/CET 

AI(1)=  (A(5)«A(9)-A(6KA(8>  »*DET 
AI(2)=-(A(2)  *A(9)-A(3>*A<8)  )  Dt  » 
AI(3)=  (A(2)*AC6)-A(3)*A(5J  >*DET 
A I  {  4  )  =-  (  A  {  4  )  *  A  (  9 )  -  A  ( 6  )  *  A  (  7  )  )  ;DE  T 
AI(5)=  (A(l) • A(9)-A(3)  -A(7) >*DET 
AI(6>=-(Ad)  :A(6)-A(3)  'A (4) )*DET 
AM  7)=  (A(4)*A(8)-A(5)*A(7)  ) -DET 
A I 18)=-(AC1)*A(8)-AC2)*A(7) )*DET 
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Al(9)=    (A(1)0A(5) 

RETURN 
END 


A (2) : A(4) )*OET 
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APPENDIX  A9 

CHAPTER  D6  SUBROUTINES   (EFFECTOR  GRADIENT) 

SUBROUTINE    SHDER  (  P  ,  M,  X  ,U  ,  N,  NS  ,  NL  ,  NO  ,  HDL  ,  NOD,  XSD  ,KB,  L) 
C    ■ 
C    SU3RGUTINE    SHDER 

C 

C    PIRPOSE 

C    TO  COMPUTE  THE  STATE  DERIVATIVES  OF  THE  SHRCUD  FORCES 

C    AND  MCMENTS  FOR  THE  DSRV 

C 

C  SLBROUTINES  REQUIRED 

C    UTCCM,ASDER,RGCCM,A3INV,GMPRD 

C 

C    OE5CRIPTICN 

C         CHAPTER.    D6,MdNcHAYES    THES  I  S  ,MI  T  ,  1971 ,  NAME    DEPARTMENT 

C 

C      ■    -  . 

DIMENSION  Pll) ,X( 1) ,U(1) TXSD(  1) ,  L(l) 

DIM  ENS  ICN  A(18),ASD(18),AH9)  rUT(3),FU(3l 

DIMENSION  DAS (6) ,DFUU(6) , DFUV16) ,DFUW(6) 

DIMENSION  DVNS(6) ,DWNS(6) tDVTS(6> ,DWTS(6) ,DUTSl 6) 

IF(  (KBoLTo2)  =  ANDo  {L{l)oEQo'>)  )GO  TO  1 

XSHR=P(M+47) 

CALL  lTCOM(U,N,XSHR,A) 

RAD=57o2957795 
C     CALCULATE  U2S( I > 

VSQ=Oo 

DO  2  1=1,3 

UT( I )=Co 

DO  3  K=1»KB 

J=L(K) 

MN=I+3  :J-3 

UT(I  )  =  UT( I )+A(MN»*X(J) 
3  CONTINUE 

VSQ=V$Q+UT(I ) iUT ( I ) 
2  CONTINUE 
C      CALCULATE  SHRGUC  ANGLE  ALPHA-S 

EPS  =  P(f-'->50) 

V=SQRT ( VSQ ) 
OCALL  ASDER(UT,AS,I,EPS,A,CAS,VNSQ,KNSQ,VVNS,WVNS,VNS, 

1DVNS,DUTS,DVTS,DWTS> 

IF{ASdLTcOo ) AS=AS+3o 141 59265 

A S=  AS-'.  RAD 
C  CCMPUTE    LIFT    AND    CRAG    COEFFICIENTS 

C  AND    DERIVATIVES 

CALL    R  GCO  M ( M , N  L  ,  P  j I ND  j  A  S  t  C  L I 

MN=M+3*NL+i 

CALL    RGCQM(MN,ND,P,IND,AS,CD) 

MN=MN+3-ND+6 

CALL  RGCCM(MN,NDL,P, IND, AS.DCL ) 
MN=MN+3*NDL+1 

CALL  RGCCM(MN»NDDjP, IND,AS,DCD) 
C      COMPUTE  VLIFT  AND  VDRAG 
B  V=Oo  5-:;P  (  M  +  49  )  *P  (  M+48  ) 
B=BV: VSQ 
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12 


15 


15 


17 


13 


VLIFT=3  CL 
VCRAG=B*CD 
CGMPUTE    VNF 

AS=AS/RAD 
CAS=COS(AS) 
SAS=SIN(AS) 
VNF=VLIFT*CAS 

FU(1  )  =  VLIFT'<S 
BEGIN  COMPUTA 
DO    6    K  =  l,6 

aa=b>ccl:  C*S( 

A3  =  B'.;CCD  :DAS( 

A02oO*(UT(l  ) 

DVL  =  AA-:-BV-  CL - 

DVD=AB+BV*CD* 

DNF=DVL*CAS+D 

DFUU(K)=DVL*S 

DVVNS=DVTS(K) 

DWVNS=DWTS (K) 

DFUV(K)=-DNF'. 

DFUVHK)=-DNF' 

CONTINUE 

CALCULATE    INV 

CALL    A3INV(A, 

PLACE    SHROUD 

J  =  l 

DO    12    K=l,6 

A( J)=DFUU(K) 

A(J+1>=DFUV(K 

A(J+2>=DFUW(K 

J  =  J  +  3 

CONTINUE 

TRANSFORM    DER 

CALL    CMPRDIAI 

SELECT    AND    FI 

DO    13    1=1, KB 

IM«LCI  ) 

DO    14    J=1,KB 

JM=L(J) 

IJA=IM*3*(JM- 

IJX=IM+6"( JM- 

IF( IMoGTo3)G0 

XSC( IJX)=ASD( 

GO    TC    14 

IF(  IMoEQo4)G0 

IF(IMoECo5)G0 

IF(IMoEQo6)GO 

XSD(IJX)=0J 

GO  TO  14 

IJW=3*JM 

XSD(IJX)=XSHR 

GO  TC  14 

IJW-3*JM-1 


AND  FU(l) 


+VDRAG"  SAS 
AS-VDRAG*GAS 

TION  OF  DFUU,DFUV,DFUW 

K) 

Ki 

-:DUTS{K)+UT(2)-DVTS<K)HIT(3):  DWTS(K)  ) 

AC 

AC 

V  D 

ASH 

/VN: 

/vn: 

vvn: 

wvni 


•SAS-FU(1K-CAS(K) 
•DVD*CAS*VNF*DAS<K) 
S-VNSQ*DVKS(K) 

IS-WNSQ-DVNS(K) 

IS-VNF*DVVNS 

IS-VNF*DWVNS 


ERSE    OF    TRANSFORMATION    MATRIX 

ah 

DERIVATIVES  INTO  A-MATRIX 


IVATIVES  TO  VEHICLE  CCORDINATES 

,A,ASD,3,3,6) 

LL  APPROPRIATE  POSITIONS  IN  XSD(36) 


1) 
1) 

TO  15 
IJA) 

TO  16 
TO  17 
TO  18 


*ASD( IJW  > 
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XSCUJX|=-XSHR*ASD<  IJW) 

14 

CONTINUE 

13 

CONTINUE 

RETURN 

1 

XSG(22)=Oo 

RETURN 

END 
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0  SUBROUTINE    ASDER  (  UT  ,  AS  ,  I ,  E  ,/>M  ,  DA  ,  VQ,  WQ,  VS  ,  WS  ,  VN  ,  DVfJ, 

q   ?.-•  )••;■;:  :- :-.  ::..::.  :  . 

C  SUBROUTINE  ASDER 

C 

C  PURPOSE 

C    TO  COMPUTE  THE  DERIVATIVE  OF  DSRV  SHROUC  ANGLE  ALPHA-S 

C 

C  SUBROUTINES  REQUIRED 

C    NCNE 

C 

C    DESCRIPTION 

C         SEE    SUBROUTINE    SHDER 

C         CHAPTER    D6,MoN*HAYES    THES I S  ,MIT , 1 971 , NAME    DEPARTMENT 

C 

c 

1DUT,DVT,DWT1 
DIMENSION    UT (1) , AM (1 ) ,DA( 1 )  ,DVN( i ) ,DVT ( 1 ) ,DWT(1) ,DUT(1) 
1=0 

VN=SQRT  (  UT  (  2  )■■ UT  ( 2  )  +UT ( 3 ) *UT ( 3 ) ) 
IF(VN: EQ.Oo )VN=loOE-08^E 
VS=UT(2)/VN 
VQ=VS/VN 
KS-UT(3)/VN 
WQ=WS/VN 

IF(UT(l)oEQ30D  )UT(1)=E 
VUT=VN/UT(1) 
VUTS=VUT/UT(1 ) 
AS=AT/>MVUT) 
SVN=SQRT(VN> 
DO    1    1=1,6 
CUT  11  l=AM(3*I-2) 
DVT( I »=AM(3*I-1I 
DhTU  )=AM(3-I  ) 

DVN{  I )=(UT(2MDVT( I )+UT (3 )*DWT( I ) )/SVN 
DA  (I  )=(DVN( I ) /UT(1)-VUTS*DUT( I)  >/{ loO+VUT*VUT 1 
1    CONTINUE 
RETURN 
END 
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SU3R0UT I NE  PRDER ( P , Mf  X, U, Nf HP , XP  , K ) 

-  ::-  '■"■■  '■  \ 

SUBROUTINE  PRDER 

PUPOSE 

TO  COMPUTE  THE  STATE  DERIVATIVES  OF  THE  PRGPELLOR  FORCES 
AND  MOMENTS  FOR  THE  DSRV 

SUBROUTINES  REQUIRED 
NCNE 

DESCRIPTION 

CHAPTER    D6,MoNoHAYES    THES  IS  , MIT, 1971 , NAME    DEPARTMENT 


LOGICA 

DI  MENS 

EPS=lc 

PN  =  F  IM 

VP=X(2 

WP=X(3 

0G1  TO 

119,20, 

236) ,K 

1  A=X(1) 
B=U(N) 
C=<U(N 
IF(AoA 
IF( AcA 
IF(oNO 
IF  UNO 
MV=M+3 
MW=MV+ 
XP-P(M 
RETURN 

2  X?=0o 
RETURN 

3  XP=Oo 
RETURN 

4  A=X(1) 
8=U(N) 
C=(U(N 
I  F  (  Ac  A 
IF(AoA 
IFtoNC 
IF(0NO 
MV-M+3 
PW=MV+ 
XP  =  P(M 
RETURN 

5  XP=Oo 
RETURN 

5    XP=Oo 


L    A, 

ION 

OE-0 

+36} 

>+PM 

)-PM 

(1,2 

21,2 


.-■■'. 
B,C 

F(l),X(i) ,U(1) 
8 


*  X  { 6 ) 

^X(5) 

,3,4,5,6,7,8,9,10,11,12,13,14,15,16,1 
2,2  3,24,2  5,26,2  7,28,29,30,31,3  2,33,34 


7,18, 
,35, 


o  G  E  o  0  o 
•  GEoQa 

)-P(M+35)*XUI loGEoOo 
NDoC) ISW=1 
NDooNOToCUSW-2 

To AoANDo  B)ISW=3 
To (AjORuB)  )  ISW=4 
*CISW-1 1+1 

1 

V)    U(N)+2©*P(MW)*X< 1) 


©GEjOo 

oGbO, 

)~P(M+35)    X( 1) )oGEoOo 

NDoC)ISW=l 

N0ooN0ToC)ISW=2 

ToAoANDcB)  ISW=3 

To  (A.ORoB)  )ISW=4 

♦  USW-ll+17 

1 

V)-:  U(NH2o:5P(MW)-X(l) 
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10 


11 


12 


13 


14 


15 


16 


17 


13 


19 


20 


RET 

XP  = 

vw= 

IF( 
XP  = 
RET 
ISW 
A  =  X 
IF( 
XP= 
RET 
XP  = 
RET 
XP  = 

vw= 

IF( 
XP  = 
RET 
XP  = 
RET 
ISW 
B  =  U 
IF( 
XP= 
RET 
XP  = 
V .,  = 
IF( 
XP  = 
RET 
XP  = 
RET 
I  SW 
A  =  X 
IF( 
XP  = 
RET 
XP= 
VW= 
IF( 
XP  = 
RET 
ISW 
B=U 
IF( 
XP  = 
RET 
XP  = 
RET 
XP  = 
RET 
XP  = 
RET 


URN 
VP*P< 

SQRT( 

VW^EQ 

XP/VW 

URN 

=  12 

(DoG 

cNOTo 

P(M+I 

URN 

Co 

URN 
P(K,  +  3 

SQRT( 
VWo  EQ 
XP/VW 
URN 

Oo 

URN 

=  30 

(N)oG 

oNOTo 

P(M  +  I 

URN 

WP*P( 

SCRT( 

VWoEQ 

XP/VW 

URN 

Oo 

URN 
=  14 
(DoG 

oNOTo 

P(M  +  I 

URN 

P(M  +  3 

SQRT( 

VWoEQ 

XP/VW 

URN 

=  28 

(N)0G 

oNOTo 

P(M+I 

URN 

Oo 

URN 

0. 
URN 
Oo 
URN 


M+32)*U 

VP - VP+W 
oOo )VW= 


EoOo 

A) ISW-I 

SW)*U(N 


(N) 
P*WP) 

EPS 


SW  +  1 
) 


3) :U(N) 
VP .VP+W 


1VP 
P*WP) 

Oo  )VW=EPS 


EoOo 

3)  ISW=I 

SW)*U(N 

M+32)*U 
VP*VP+W 
oOB >vw- 


SW  +  1 

) 

INI 
P*WPJ 

EPS 


EoOo 

A) ISW=I 

SWJ*U(N 

3)*U(N) 

VP-'VP  +  W 
cOo )VW= 


EoOo 

B)ISW=I 

SWI#U(N 


SW  +  1 

) 

vWP 

P*WPJ 
EPS 


SW  +  1 

) 
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23 


24 


25 


26 


27 


25 


29 


30 


31 


32 


33 


34 


i3 


36 


XP 
RE 
XP 
RE 
XP 
RE 
XP 
RE 
XP 

vw 

IF 

XP 
RE 
XP 
RE 
IS 
A  = 
IF 
XP 
RE 
XP 

IF 
XP 
RE 
IS 
B  = 
IF 
XP 
RE 
XP 
RE 
XP 
VW 
IF 
XP 
RE 
IS 
A  = 
IF 
XP 
RE 
XP 
RE 
XP 
VW 
IF 
XP 
RE 
XP 
RE 
IS 
B  = 


=  0o 

TURN 
=  0. 
TURN 
=  03 
TURN 
=  0> 
TURN 
=-P(M+ 
=SQRT( 
(  V.lo  EQ 
=  XP/V.. 
TURN 

=  0o 

TURN 

W=14 

XdloG 

(oNCTo 

=--P(M+ 

TURN 

=-P(M+ 

=SSRT( 

{  VWoEQ 

*XP/VW 

TURN 

W=2  8 

U(N),G 

(oMCT, 

=-P(M+ 

TURN 

=  Co 

TURN 

=    P(M  + 

=SQRT( 

(VWoEG 

=XP/Vw 

TURN 

W-12 

X(l)oG 

loNOTo 

=FCM*I 

TURN 

=  0o 

TURN 

=    P{M  + 

=SQRT( 

(VWoEQ 

=XP/VW 

TURN 

=0« 

TURN 

VJ=30 

U(M 


36  J* 

VP*V 

Q  0  O   ) 


WP-::P(M+32)'.:U(K) 

P*WP*WP) 

VW=EPS 


EoOc 
A)  IS 
ISW) 

33) 

VP*v 

oO,  ) 


W=ISW+1 
*U(N)*P<M+36I 

U(N)*WP*P(M+36) 

P+WP*WP) 

VVi=EPS 


EoO. 
B)  IS 
ISVi) 


W=ISW+1 
*U(N)*P(M+36) 


36)* 

VP*V 

oOo  ) 


E,03 
A)  IS 
SW] 


331* 

VP:  V 

oOc    ) 


VP*P(M+32)*U(N) 
P+WP*WPJ 

VW=EPS 


W=ISW+1 

U(N)  :  P(M-:-36) 


U(N  >*VP*P(M4-36I 

P+WP*WP) 

VW=EPS 


GEoO: 
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IF(oNOToB)ISW=ISW+l 

XP=  P  tM+ISW I  •  U ( N ) *P ( M  +  36 ) 

RETURN 
END 
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SUBROUTINE  THDER( P ; M , U ,N, X , XT , K  ) 

C  *"•** 

C  SUBROUTINE  THDER 

C 

C  PLRPOSE 

C  TO  COMPUTE  THE  STATE  DERIVATIVES  OF  THE  THRUSTER  FORCES 

C  AND  MOMENTS  FOR  THE  DSRV 

C 

C    S13RQUTINES    REQUIRED 

C        RGCOM 

C 

C  DESCRIPTION 

C    CHAPTER  D6, Ms  N:>  HAYES  THESI  S  ,MI  T  ,  1  971 ,  NAME  DEPARTMENT 

C 

DIMENSION  P(I  ),U(1)  tlM(l)  ,X(  1) 
IF(KoGTo6)G0  TO  21 
GO  TO  (1,2,3,A,5,6J tK 
21  XT=03 
RETURN 

1  XT=Oo 
I=N(2)-1 
NT=N(1) 
JS=10 
JR=-1 
MV=M+207 

DJ  7  J=1,NT 
JS-JS+JR 
IJ=I+J 
JT=JS+2 
MV=KV+JR*16 
UI=ABS(U( I  J)  ) 
IF(UIoEQ30d )GO  TO  16 
A=X(1)/UI 
PV=P(M+128) 
IF(A:,GTJPV)A  =  PV 
PW  =  P (M+127*) 
IF(AoLToPW)A=PW 

CALL  RGCGMlMVfN(JT) ,P» IRi  A,TS  ) 
XT=XT+ABS(U( I  J)  J*TS 
16  JR=-JR 
7  CONTINUE 
RETURN 

2  XT=Oo 
I=N(2|-1 
ISW  =  0 

JT  =  9 

MV-M+129 
PV=P(M*120! 
PW=P( M+127) 
12    1=1+1 

UI=ABS(U( I ) ) 
IFCUIoEQoOe )GO    TO    17 
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-T9*r 

Ll    01    09  ( a0 

( { i )n)sav=in 

1-5-1  =  1    ?T 
U?T  +  W)d=Kd 
(82T+W)d=Ad 
6?T+W=AW 

6=ir 

0  =  NSI 
I-IZ)N=I 

co=ix  ^ 

30NI1NG0    i 

Si*(  (n  )n)S9v+ix=ix 

(Sl'VUI  'd'  ( IDS!' AW)  WOOD*    TiVO 

Md=V(Md°ll°V)dI 

{  A?T  +  vJ)d  =  Md 

Ad=V{ Adr19ctf  HI 

(8ZI+W)d-Ad 

IR/(T)X=V 

9T    01    09 ( c0c03&10) JI 

( (Pi >n)S8v=in 

9T*ar+AW=AW 

z+sr=ir 

r  +  i=n 

ar+sr-sr 

iN*T=r  l   ca 

;_oz+w=aw 
i-=yr 
oi=sr 

(T)N=1N 

i-mN=i 

°0  =  1X  T 

Nanisy 
co=ix  \z 
**  (g's'^'e'e*!)  oi  09 

\Z    Oi    09(9°19C>U3I 
(T)X' (I)M*( I)n*( T)d    N0ISN3WI0 

J^££  fc(      3 

D 

lN3NiyVd3a    3WVN'U6T,1IW'SIS3H1    S3AVH°N°W'9a    *31dVH3        3 

N3IldiyDS3C   3 

3 

W099H        3 

G3yinQ3H  s3Niinoaeis  a 

3 

AtfSQ    3H1    yOd    S1N3W3W    ONV        3 

S33>J0d    iJ3iSnyHl    3H1    30   S3AUVAI«3a    31V1S    3H1    3indW00   01        3 

SSOdiHd   3 
3 

M3GM1  3Niincaens  3 
(>»*ixlx'Nln*wid)y3aHi  3Niinobons 


SUBROUTINE  THDER( P ; M , U ,N, X , XT , K  ) 

C  *"•** 

C  SUBROUTINE  THDER 

C 

C  PLRPOSE 

C  TO  COMPUTE  THE  STATE  DERIVATIVES  OF  THE  THRUSTER  FORCES 

C  AND  MOMENTS  FOR  THE  DSRV 

C 

C    S13RQUTINES    REQUIRED 

C        RGCOM 

C 

C  DESCRIPTION 

C    CHAPTER  D6, Ms  N:>  HAYES  THESI  S  ,MI  T  ,  1  971 ,  NAME  DEPARTMENT 

C 

DIMENSION  P(I  ),U(1)  tlM(l)  ,X(  1) 
IF(KoGTo6)G0  TO  21 
GO  TO  (1,2,3,A,5,6J tK 
21  XT=03 
RETURN 

1  XT=Oo 
I=N(2)-1 
NT=N(1) 
JS=10 
JR=-1 
MV=M+207 

DJ  7  J=1,NT 
JS-JS+JR 
IJ=I+J 
JT=JS+2 
MV=KV+JR*16 
UI=ABS(U( I  J)  ) 
IF(UIoEQ30d )GO  TO  16 
A=X(1)/UI 
PV=P(M+128) 
IF(A:,GTJPV)A  =  PV 
PW  =  P (M+127*) 
IF(AoLToPW)A=PW 

CALL  RGCGMlMVfN(JT) ,P» IRi  A,TS  ) 
XT=XT+ABS(U( I  J)  J*TS 
16  JR=-JR 
7  CONTINUE 
RETURN 

2  XT=Oo 
I=N(2|-1 
ISW  =  0 

JT  =  9 

MV-M+129 
PV=P(M*120! 
PW=P( M+127) 
12    1=1+1 

UI=ABS(U( I ) ) 
IFCUIoEQoOe )GO    TO    17 
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9    RETURN 
6    XT=Ch 

I=N{2)-1 

ISW  =  0 

JT  =  13 

MV=M+235 

JV  =  iM+123 

PV=P(M+128) 

PW=P(M-H27) 

10  1=1+1 
UI=ABS(U(1  )  ) 
IFtUIoEQoOo )G0    TO    20 
A=X(1)/UI 

IF( AoGToPV)A=PV 
IF(AoLToPW>A=PW 

CALL  RGCOM(MV,N(JT) fPtIR»AfTS) 
XT  =  XT  +  P( JV)  :U( I  )  TS 
20  MV=MV+31 
JV=JV+1 
JT=JT+1 
ISW-ISW+1 
GO  TO  (10,11) ,ISW 

11  RETURN 
END 
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SUBROUTINE  PRDEP ( P ,M, X ? U- N , NP ,XP , K , J  ) 

C  '  ■.■■■■■.■ 

C  SUBROUTINE  PRDEP 

C 

C  PURPOSE 

C         TQ    COMPUTE    THE    DERIVATIVES    WITH    RESPECT    TO    BSRV 

C         PROPELLOR    PARAMETERS 

C 

C  SUBROUTINES  REQUIRED 

C    NONE 

C 

C    DESCRIPTION 

C         CHAPTER    Do, Mo N, HAYES    THES  I  S  ,M  I  T , 1971 ,NAME    DEPARTML 

C 

C    '  ?  <■'  -:  •'■  ■ 

DIMENSION    P(l  ),X(i ),UQ> 

LOGICAL    A,G,C 

PN.  =  P(M  +  36) 

VP  =  X(2  )  +  PM    X(6) 

WP=X(3)-PM*X(5) 

GO    TO     (1,2,3,4,5,6),K 
C  SURGE    REGION    DETERMINATION    ANJ    EQUATION    SELECTION 

1    A  =  X(1)  iGEaO.0 

B  =  U(i\)oGEoOa 

C-(U(N)-P(M+35)*X(1) )oGE3Co 

IFtAcANCoC)  ISW=1 

I  F(  AoANDo  JN0ToC)ISW=2 

IF(oNOToA3ANDc B) ISW=3 

IFtoNOTo (AoORc B) ) ISW=4 
C  PROPELLOR    SURGE    EQUATIONS 

NT=M+3  2 

[F(J.MEoNT)Ga    TO    21 

XP=U(N)*SQRT(  VP  *VP+WP*WP) 

RETURN 

21  GO    TG     (7,8,9,10) , ISW 
7    NT=M 

IF(JoNEoNT)G0    TO    19 
XP  =  U(N)s:ABS(U(N)  ) 
RETURN 

19  NT=M+1 

IF{ JoNEoNT )GO    TO    2  0 
XP  =  X(1  )-'U(N) 
RETURN 

20  NT=M+2 

IF( JoNEoNTJGO    TO    22 

XP-XC1I*XU1 

RETURN 

22  XP^Oo 
RETURN 

3    NT=M+3 

IF(J&NEoNT)GO    TO    23 
XP  =  U(N)-:A3S(U(N>  ) 
RETURN 
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23  NT  =  M-s-4 

IF(  JoNEoNDGO  TO  24 

XP=X(lp:  U(N) 

RETURN 
2  4  NT-M+5 

IF( JoNEoNTJGO  TO  22 

XP^X(l)  X( 1) 

RETURN 
9  NT=M+6 

IF(JoNEoNT)GO    TO    25 

XP  =  U(N):  ABS(U(N)  ) 

RETURN 

NT=M+7 

IF( JcNEoNT )G0    TC    26 

XP=X(1 ) • U(N) 

RETURN 

NT=M+8 

IF(  JoNEoNDGO    TO    22 

XP  =  X(1  I*XU1 

RETURN 

NT=M+9 

IF(JoNEoNT)GO    TO    27 

XP  =  U(N)~  ABS(U(N)  ) 

RETURN 

NT=M+10 

IF(JoNEoNT)GO    TO    28 

XP=X(1 J-U<N) 

RETURN 

NT=M+11 

IF(  Jo  N  Eo  NT)  GO    TO    22 

XP-=X(1  )  :x(3.) 

RETURN 

SWAY    REGION    DETERMINATION    AKD    EQUATION    SELECTION 

2  IF(U(N)cLTcOo  )GO    TO    11 
PROPELLCR    SHAY    EQUAT1CNS 
NT-M+12 

IF(JoNEcNT)GO    TO    22 
XP=U(N)*VP 

RETURN 

11  NT=M*13 

IF( JoN£oNT)GO    TO    22 

XP  =  U(N);  VP 

RETURN 

HEAVE  REGION  DETERMINATION  AND  EQUATION  SELECTION 

3  IF(U(N)oLToOo )G0  TO  12 
NT=K+14 

IF( JoNEoNTIGO    TO    22 

XP=U(N)*WP 

RETURN 

12  NT=M+15 
IF(JoNE0NT)GO    TO    22 
XP=U(N)*KP 

RETURN 

-hC^- 


lo 


26 


10 


27 


2i 


29 


30 


13 


32 


1* 


33 


34 


15 


35 


36 


A  =  X 

3  =  U 

C=( 

NT= 

IF( 

XP  = 

RET 

NT  = 

IF  t 

XP  = 

RET 

IF( 

IF( 

IF{ 

IF{ 

GO 

PRO 

NT  = 

IF( 

XP  = 

RET 

NT= 

IF( 

XP  = 

RET 

NT= 

IF( 

XP  = 

RET 

NT= 

IF( 

XP  = 

RET 

NT  = 

IF( 

XP  = 

RET 

NT  = 

IF{ 

XP  = 

RET 

NT  = 

1F( 

XP  = 

RE1 

NT= 

IF( 

XP  = 

RET 

NT= 

IF( 

XP  = 

RET 


(DoG 
(N)»G 
U  (  N  )  - 

M+33 
Jo  NEo 
U  (  l\  )  i 
URN 
K  +  34 
JoNEo 
U(N  +  1 
URN 
A^NC 
AcAND 
oNOTo 
o  NCTo 
TO    (1 
PELLG 
M+16 
JoNEo 
U(.\) 
URN 
M  +  17 
Jo  NEo 
X{1)^ 
URN 
M+18 
JoNEo 
X  ID- 
URN 
M  +  19 
Jo  NEo 
U  ( N  ) 
URN 
M  +  2C 
JoNEo 
X(l  I* 
URN 
M  +  21 
Jo  NEo 
X(l)^ 
URN 
M+2  2 
JoNEo 
U(N)* 
URN 
H  +  23 

Jo  N  C o 

X(l)-v 

URN 
M  +  24 
JoNEo 
X(l  )* 

URN 


EoOa 

E  o  Co 

P(M  +  35KX(1)  )oGEo0o 

NT) GO    TO    2  9 
SQRT<VP*VP*WP*WP) 


NT)G0    TO    30 
) 

c  C)  ISW=1 
B.N0TaC)ISW-2 
AoANDoBJISW=3 
(Ac  OR, B) ) ISW-4 

3, 14,. 15, 16), I SW 
R    ROLL    EQUATIONS 

NT)G0    TO    31 
ABS(U(N) ) 


NTJGO    TC    32 
U(N) 


NT)G0    TO    22 
Xf  11 


NT)  GO    TO    33 
A3S(U(N) ) 


NT5G0    TO    34 
U(NJ 


NTJGG    TO   22 
X(l) 


NT)GO    TO    35 
ABS(U(N) ) 


NT)G0    TO    36 
U(N) 


NT)G0    TO    22 
XU.  ) 
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16  NT=M+25 
IF(JoNtoNT)GO    TO    37 
XP=U(N)*ABS(U(N) ) 

RETURN 
3  7    NT=M+2  6 

IF(JoNEcNT)G0    TO    38 
XP=X(1  J*U(M 

RETURN 
33  NT=M+27 

IF( JcNEoNTIGO  TO  22 

XP  =  X(1  |iX( u 

RETURN 

PITCH  REGION  DETERMINATION  AND  EQUATION  SELECTION 

5  IFtUtNJcLT^O,  )GO  TO  17 
PRGPELLOR  PITCH  EQUATIONS 
NT-M+28 
IF(JoNEoNT)GO  TO  22 

XF  =  U(N)-'WP 
RETURN 

17  NT=M+29 

IF( JoNE*NT)GO  TC  22 

XP=U(N)*WP 

RETURN 

YAW    REGION    DETERMINATION    ANC    EQUATION    SELECTION 

6  IF(U(N)cLToO.    >GO    TO    18 
PROPELLOR    YAW    EQUATIONS 
NT=M+30 

IF(  JoNEsNT  )GO    TO    22 
XP=U(N)*VP 
RETURN 
13    NT=M+31 

IF( JoNEoNT)G0    TO    22 

XP=UIN)*VP 

RETURN 

END 
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SUBROUTINE    THDEP ( P, M, U ,N, X, XT ,K, J ) 

q    i<:    '?  *  '•  yv \--::' ■■■  ■- 

C  SUBROUTINE  THDEP 

C 

C  PURPOSE 

C  TO  COMPUTE  THE  DERIVATIVES  WITH  RESPECT  TO  DSRV  THRUSTER 

C  PARAMETERS 

C 

C    SU3ROUTINES    REQUIRED 

C         RPDER,RGCCM 

C 

C    DESCRIPTION 

C        CHAPTER    D6,MoNoHAYES    THES IS $ MIT,1971f NAME    DEPARTMENT 

C 

Q     ...  •    -;:  ... 

DI MENS  ION    P 11  )  ,  U  v 1 ) , N ( 1 ) i X { 1 ) 

GO  TO  Ut2t3»4f5,6)fK 
C     THRUSTER  SURGE  EQUATIONS 
1  XT=Oo 

I=N(2)-1 

NT=NU) 

JS  =  4 

JR=-1 

MV=M+60 

DO  7  J*ltNT 

JS=JS+JR 

IJ=I+J 

JT=JS+2 

MV=MV+JR*10 

UI=ABS(U(IJ) ) 

IFtUIoEQoOo )GO  TO  16 

A=X(1)/UI 

PV=P(M+128) 

IF(A;,GTc.PV)A  =  PV 

PW=P(M+127) 

IF(AoLT0PW)A=PW 

CALL    RPDER(MV,N(JT) , P r IR» A, XT , J  ,  L ) 

XT=XT*U( IJ  )-:U(I  J) 

IF(LoNEoO)GO    TO    13 
16    JR--JR 
7    CONTINUE 

RETURN 
C  THRUSTER    SWAY    EQUATIONS 

I    XT=0o 

I=N(2)~1 

ISW  =  0 

JT=3 

MV  =  M 

PV=P(M+128) 

PW=P(M+127J 
12  1=1+1 

UI  =  AES(U(  I  )  ) 

IFCUUEQoO.  )GO    TO    17 

-468- 


17 


13 


14 


13 


15 


21 


A=X ( 1  ) 

IF(AcG 

IF(AoL 

CALL  F 

XT  =  XT;! 

IFCLoN 

MV-MV+ 

JT=JT+ 

ISW=IS 

GO  TG 

RETURN 

THRUST 

XT  =  03 

I=N(2) 

I  SV.'  =  C 

JT=2 

MV=M 

PV=P(f 

PW=P(M 

1=1  +  1 

UI=ABS 

IF(UIc 

A=X(1) 

IFCAoG 

IF(AoL 

CALL  R 

XT=XT? 

I  F  {  L ,  N 

MV=MV+ 

JT=JT+ 

ISW=IS 

GO  TO 

RETURN 

THRUST 

XT  =  Oo 

RETURN 

THRUST 

XT  =  CC 

I  =N  (  2  ) 

JV=M+1 

IF( JoN 

XT=U(  I 

RETURN 

ISW=0 

1  =  1  +  1 

MV=M+7 

JT=7 

JV=M+1 

PV=P(K 

PW=P(M 

1=1  +  1 

UI=ABS 

I  F  (  U 1  o 


V)A=PV 

W)A=PW 

R(fSV,N(JT),P,  lR,A,XT,Jf  L) 
) ' ABS(U( I) ) 
)G0  TO  13 


/UI 

ToP 

ToP 

PUE 

U(I 

E.,0 

25 

1 

W  +  l 

(12,13) ,ISW 

ER  HEAVE  EQUATIGNS 
+  1 


+  128) 
+  127) 


(U( 

ECo 

/UI 

TeP 

T.oP 

PDE 

U(I 

E*0 

25 

1 

W  +  l 

(14 


I)) 

Oo  )G0  TO  18 

V) A=PV 
W)A=PW 

R(MV,N(  JT  )  ,P,IR,  A,  XT,  J,  L 
)  ABS(U(I)) 
)G0  TO  13 


, 15)  ,ISW 


ER  RCLL  EQUATIONS 


ER  PITCH  EQUATICNS 


22 

EoJVlGO  TO  21 

)*ABS<UU  )  )  +U(1+1)*ABS(U{  I  +  ll  J 


20 

+  128) 
+  127) 

(U( I)) 

EQoOo )G0  TO  19 

-469- 


11 


19 


10 


23 


20 


11 


A=xm 

IFUoG 

IF(A3L 

I  F  (  J  o  N 

CALL    R 

XT  =  T5-: 

RETURN 

CALL    R 

XT  =  XT-: 

IF(LoN 

MV=KV+ 

JV=JV+ 

JT  =  JT-: 

ISW=IS 

GO    TO 

RETURN 

THRUST 

XT  =  Co 

I=N(2) 

ISW-0 

MV=M+7 

JT  =  7 

JV=M+1 

PV=P(K 

PW=P(K 

1  =  1+1 

UI=A6S 

!  F  ( U  U 

A  =  X( 1 ) 

IF(A,G 

IFtAoL 

IF(   Jt:N 

CALL  R 
XT  =  TS 
RETURN 
CALL  R 
XT  =  XT<= 
IFUdN 
MV=MV+ 
JV=JV+ 
JT=JT+ 
I  S  v :  =  I S 
GO  TO 
1  =  1  +  1 
IF(JoN 
XT=U(I 
RETURN 
END 


/UI 

ToPV)A=PV 
ToPW)A=PW 
EeJVJGO    TC    22 

GCCM(MV,N( JT),P, IR,A,TS) 
U( I  )     A3S(U(  I)  ) 

PDER(MV,N(JT)  ,P,  IR,  A,XT,J,L) 

U(I  ) ■-■  A3S(U{  I  )  )'  P(  JV! 

E*0)G0    TO    13 

22 

1 

1-!  +  ] 
(8,9), I SW 

ER    YAW    EQUATIONS 

-1 


23 

+  123) 
+  127) 

(  U  {  I  )  ) 

EQ©0« )G0    TO    20 

/1 1 

T0PV)A=PV 

T0PW)A=P'h 

E.JV)G0    TO    23 

GCDM(MV,N(JT),P, IR, A,TS) 

U(I )*ABS<U( I) ) 

PDER ( HV , N ( JT ) , P , I R , A , XT , J . L ) 

U(I >*ABS(U< I) >*P(JV) 

E*0)GO    TO    13 

22 

1 

1 

H+l 

(10,11) , ISW 

EcJVJGO    TO    13 

)>;ABS(U(I  )  )+U(I  +  l)-ABS(U(  I+i)) 
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SUBROUTINE  RPDER{N,N,P, ItX,Y,JsL) 

C  #:  *•*:?#**#****••**."•*#**#:  .   • 

C  SUBROUTINE  RPDER 

C 

C  PIRP3SE 

C  TO  COMPUTE  THE  PARAMETRIC  DERIVATIVES  OP  A  LINEAR  V£LUE 

C  WITHIN  A  RANGE  WITH  RESPECT  TO  STRAIGHT  LINE  SLOPES 

C  AND  INTERCEPTS 

C 

C  SUBROUTINES  REQUIRED 

C  NONE 

C 

C  OESCRIPTICN 

C  CHAPTER    D6,MaMcHAYES    ThESISf MIT »1971 f NAME    DEPARTMENT 

C 

C       :.      I  .... 

DIMENSION    P(l) 

L  =  0 

DO    1    K=1,N 

IF(yoGTBP(M+K))GO    TO    1 

I=K 

MV=M+N+K 

IF( JoNEcNT)GO    TO    2 

Y  =  X 
L-l 
RETURN 

2  NT=NT+N 

IF ( Jo NEo NT) GO    TO    3 

Y  =  lo 
L  =  2 
RETURN 

3  Y=Oo 
RETURN 

1    CONTINUE 

Y  =  Oo 
RETURN 
END 
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APPENDIX  .MO 

THE  MEAN  OF  A  SQUARED  GAUSSIAN  RANDOM  VARIABLE 

Given  a  normally  distributed,  zero  mean  random  variable  x  as 
expressed  by  equation  A10.1,  and  a  general  squared  transformation  as 
in  equation  A10.2,  the  resulting  random  variable  y  is  shown  to  be  of 
non-zero  mean  given  in  equation  A10.3* 

x  -  N  (0,  a2)  A10.1 

y  =  a  x2  A10.2 

Efy]  =  a.o2  A10.3 

The  probability  density  function  for  x  is  given  by  equation  A10.4 

and  the  associated  probability  density  function  for  y  is  given  by 

equation  A10,5  (P-3«  P«  130)  •   The  mean  of  the  random  variable  y  is 

expressed  by  equations  A10.6  A10«?,  and  A10.8. 

x2 


f  (y)   -     1 e     2ac?2  U(y)  A10.5 

o\/2iray 

U(y)  »  step  function  in  y 


■  [y]  =  f  y  tJi)  dy  ^0-6 


_  X 

E  [y]  «  /     -£_ e     2aa3  dy  A10.7 
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Cy]  -  K  jf  ^  ."*  dy 


AlO.o* 
Where  K  =  1 


2a<T 

The  integral  in  equation  A10.8  may  be  transformed  to  the 
integral  in  equation  AlOdO  by  using  the  separation  of  variables  in 
equation  A10.9.   Equation  A10.10  is  a  standard  definite  integral 
(S-28,  Integral  #531)  whose  result  is  given  by  equation  A10.ll. 

S   udv  =  S   vdu  -  uv|  A10.9 

Where:  u  =  Jy  dv  ■  d  y  dy 

du  «  iy"^      v  -  -  I  e-by 

b 

^  n   K   r~  e"by  , 

*tf  "  2b~  £  #"~  dy  A10'10 


r^dy-/5  A10.U 

0  ^T     7b 


With  the  substitution  of  equation  A10.ll  into  A10.10  the  result  is 
directly  given  by  equation  A10,3«  This  then  shows  that  the  mean  of 
the  square  of  a  zero  mean  gaussian  random  variable  is  net  necessarily 
of  zero  mean*  Many  of  the  biases  arising  in  identification  processes 
for  nonlinear  stochastic  systems  may  be  partially  or  wholly  attributed 
to  this  fact. 
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APPENDIX  All 

AJjONLIWEAR  OBSERVABILITY  CRITERION  APPLIED  TO  THE  DSRV  SINGLE  DEGREE 
OF  FREEDOM  EQUATION 

A  nonlinear  dynamic  system  given  by  equations  All.l  and  All. 2  is 

observable  if  S,  u(t)t  and  y(t)  determine  x  uniquely,  A  sufficiency 

criterion  for  checking  nonlinear  system  observability  is  given  by 

Schoenwandt  (S-5)  and  is  applied  here  to  the  DSRV  single  degree  of 

freedom  equation  A11.3*   The  general  nonlinear  state  estimation  problem 

for  equation  All. 3  is  given  by  equations  All.'}  and  A11.5* 


x  »  f  (xj  u,  t) 


y.  =  £  (*•  H»  i) 


x  =  axs  +  bu: 


[t0,  tj 


x    S 
o 


y  =»  ex 


All.l 
All. 2 
All.  3 


*1 
x~ 


H   xl  +  x3  u* 

o 

o 


y    -  [C  0  0]   [xx  X^  X3J 


-,T 


All.  k 


All. 5 


Schoenwandt* s  criterion  consists  mainly  of  finding  enough  initial 
values  of  y_  and  its  derivatives  to  specify  x^.  The  following  chain 
(All. 6  -  All. 15)  of  equations  develops  the  observability  criterion 
steps  for  c  -  1  in  Schoenwandt1 s  terminology.  Equations  All. 6  through 


u(t)  =  u0 


uo  =  0 


All. 6 

All. 7 
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y  -  x, 


All. 8 


go  =-  ^0 

gi  ■  at 

t  ^x 

0 

f(V    V    *©)        ^ 
*o 

u(t   ) 


All.  9 


All. 10 


Si    ^ 


So   = 


X20  XI0  +  x30  Uo 


^fl 


agx 
t    ^x 


f(V    V    t0)       ^ 


au 


u(t   ) 


All. 11 


All. 12 


g2 

-  2xic 

1  X20  Si 

g3 

te2 

t  +  *r 

o 

f(v  v  V   K 
+  au 


All. 13 

ft(t ) 

°    Ali.]':- 


g0  =  ef  /  g,   +  2x 


20  gi 


All. 15 


All.  15  can  nov/  "be  shown  to  determine  x  uniquely  in  terms  of  g  ,  g  , 
g2,  and  g  as  in  equations  All .16  through  All. 18 , 


x   «=  g    uniquely 
J.U     o 


All.  16 


X20  =  ^S3  gl  "  gP  ^  2gl    uniquely;  ^   /  0      All. 17 
X30  -  gl  (1  "X20  gl)  /  Uo  Uili(iuel-V!  u0  *   °      A11'18 


The  initial  state  vector  x  is  uniquely  determined  in  equations 

A11.16  through  All. 18  and  therefore  the  nonlinear  state  estimation 

problem  is  observable  and  all  of  its  states  may  be  estimated.  The 

condition  g-j  ^  0  imposes  a  limitation  on  the  initial  value  of  the 

input  function  given  by  equation  All. 19.  This  equation  simply  says 
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that  the  system  is  not  initially  at  its  steady-state  value.  The 

u2  +.   -  ^2.  x?n  All.  19 

o  '    x™  10 

other  condition  on  the  input  u  ■(■   0  says  that  there  must  be  some 

o 

initial  non-zero  input  to  the  system  for  observability  to  be  possible. 
This  appendix  applies  to  Chapter  P2,3. 
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APPENDIX  A12 
CHAPTER  P?  MOD-EL  Rgj^^^GLJ^Ly  AND  SUBiWj 

C  PROGRAM    FOR    NONLINEAR     IDENTIFICATION    COST    FUNCTJ 

c  w  n  h  r>  c  l  s  e 

REAL    M 

D I  ME  NS I CN  VEC <  4  7 ) , XM ( 47 ) , XV { 94 1 
DI MENSIGN  CC(47J  fCN(51  )  ,CCST(2397 ) 
D I  ME  NS I  ON  P ( 282) , OD ( 5 ) , GG < 5 ) 
CCMMCN  /PNOIS/A  1,5 
COMMCN  /PND/D 
CGMMCN  /PNG/G 
AN-  o 
S-l. 
NCD=2 
II   =2 
M=4  5C7, 
CDZ=-1£ ,7 
CN7=755o 
CCST=-22o2 
CKST=555. 
DELCD=0»25 
DELCN=10. 
*Z=CCZ/M 
PZ=CNZ/M 
C=l, 

AST=CDST/M 
BST=CNST/M 
DA=CELCD/M 
CB=OELCN/M 
K  =  47 

REAC(5,20MDD( I  ) ,1=1,5) 
REAC(5,20)(GG(  I  ),I  =  1,5) 
20    FCRIvAT(iOF3«2) 
T  1  =  0  • 
X  1=0. 
F.  =  1 0  . 
IXV=111 
IXW=11 
N  P  L  =  4  7 
NCN=51 
NCD=47 
ICN=NCN-1 
ICD=NCD-1 
NS=0 
NC  =  1 

CC(1  )=CDST 
0  0    5    I  =  1 , 1 C  D 
CC(  I  +  i  )  =  C  )(  IH-OELCO 
5    CONTINUE 
Ci\(  1  )=CNST 
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11 

10 


WD  B  PV    1   [  VARIAT1    AMD  COS!  CALCLLATIC  i 


DO    6    J=1»ICN 

CM J+l )  =  CN< J )+DELCN 

CONTINUE 

CO    10     IDD=1,NDD 

u  =  C  C  (  I  C  D  ) 

DC    11    IGG=1,NGG 

G=GG< IGG ) 

CCMPUTE    VEC 

CALL    RMH,TI  ,XI,K,N,AZ,BZ,C,VEC,!XW,  IXV) 

CO     1    K=1,NPL 

XV( K)=TI+FLGAT< K)«H 

XV(K+NPL  )  =  VEC(K I 

CCNT  II 

CALL     PL 01  (0  ,XV,NPL,2,    I J 

BEGIN 

B  =  BST 

DC     3    J=1,NCN 

A-AST 

DO    2    1=1  ,NCD 

CALL    RKINT(H,  TI,XI  ,N,A,B,C,XMI 

NC=i J-l )  *NCD+I 

COSTCJC  )=  ). 

DO    4    JSQ=1 iN 

INTEGRATE    THE    SQUARE    C 

XDIF=VEC<  JS  3)-XM  JSQJ 

COST  CJC l=COST (NC >+XDIF 

CONTINUE 

A=AST  +  CA     PL   'AT  (  1-1  ) 

C(  NT  INUE 

B=BST+CB*FL JATl J-l ) 

CCNT  INUE 

CALL    C C NTU R ( NO , CD  , CN ,  C OST , NCDf NCN , N S ) 

PLOT    SETUP 

DO    7     1=1, NCD 

P( I ) =CD[  I  ) 

P(NCD* I >=COST< I ) 

P (2*NCD+I )=COST{ 13*NC0H I ) 

P  (  2  -I  iCO+  I  )=C0ST(25*NCD+I  ) 

P  (4«NCD+  I  NCOST(  38s*  NCO  +  1  ) 

P( 5  *NCD  + I l  =  COST ( 50*NCD* I ) 

C<    ITINUE 

C^LL    PLOT(Ni 

N  0 = N  u + 1 

CO NT  INUE 

CO NT  INUE 

STOP 

END 


THE    ERPCF 

XC  IF  •  H 


IfP, 


NCD, fc,NS) 
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REAL    F:UNCT  ION    F{T,X,U,A,B,W) 

NONLINEAR    ABSOLUTI     SQUARE    LAW 

COMMCN    /PNG/G 

F=A  ■■■<    ABS(  X)  +bUj-AbS(U)4G' 

RETURN 

ELD 


.1 


V  Eh  [CLE 


SUBROUTINE  RK(Hf 
DIMENSICN  VEC(l) 
COMMCN  /PND/D 
X  =  XI 

t=ti 

CC  2    I  1=1,  I 

U  V  =  U  (  T  ,  X  J 

WV=W(  IX  I) 

VV=V(IXV) 

X=X+H*F( T, XfUV,AfB,WV) 

T  =  T+H 

VFC(  I  I  >=X+D*VV 

CONT  INUE 

RETURN 

t-r  d 


ri »XI,Kf Nf A, B, CtVECi IXW,  I XV) 


SUBROUT INE  RK HT  (  H,  T  I  ,  X  I ,  N  ,  4  f  B ,  C  t  VEC 1 

DIMENSION  VECH  ) 

X  =  XI 

T  =  TI 

DO  2  1=] ,N 

JV=U(T,X) 

X=X+H*FUN( Tf y ,UV, &tB) 

T=T+H 

VFC( T )=X 

CONTINUE 

RETURN 

END 


REAL  FUNCTION  FUN ( T , X  ,  L , A , B ) 


NONLINEAR  ABSOLUTE 
FUN=A*X*A3S  (X)  +  B*U: 
RETURN 

ENC 


SQUAR E 
A  B  S  (  U  I 


L  A  W 


IDEL 
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REM      F  '  INC  T  TOM    V(  I  X) 
N(%1)     DISTRICT  t:h 
COMMON    /PNOIS/AM,S 
CALL    GAUSS( IX,S,AM,V) 
RFTURN 
END 


REAL  FUNC1 I UN  L( T, X) 

STEP  INPUT  Qf  UNIT  HEIGHT 

U=i. 

RETURN 

END 


RFAL    FUNCT  ION    M  (  IX.) 
C  NfO, 11     OISTR IBUTI IN 

COMMON    /PNOTS/AMf S 
CALL    GAUSS(IX,S,AM,W) 
RETURN 
ENO 

Additional  Subroutines! 

GAUSS,   RANDU  Appendix  A^ 

CONTUR,   PLOT  Appendix  A5 
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APPENDIX  A13 


MODEL  REFERENCE  STUDIES  OF  A  LINEAR  SURGE  EQUATION 

Many  of  the  studies  conducted  in  Chapter  P3  for  the  nonlinear 
DSRV  surge  equation  were  also  conducted  upon  the  linear  equation 
A13«l.  Many  of  the  same  inputs  were  used  and  most  of  the  results  are 
presented  here  in  the  same  form  as  in  Chapter  P3.  The  inputs  used  in 


450?  x  *  -100x  +  755  u 


A13.1 


these  studies  are  the  step,  staircase,  simulated  impulse  and  sinu- 
soidal with  150  second-period.  A  listing  of  the  applicable  tables 
and  figures  is  given  in  Table  A13.1.   The  inputs  correspond  to  tl 
in  Chapter  P3. 


• 

Input 

Contours 

Noise  Behavior 

• 

Step 

Figure  A13#l 

Table  A13.2 

Staircase 

Figure  A13.2 

Table  A3. 3. 3 

Impulse 

Figure  A13»3 

Table  A13.4 

Sinusoidal -150 

Figure  A13.4 

Table  A13.5 

Ta 

ble  A13.1     TABLES  AND  FIGURES  FOf 

I  LINEAR  MODEL  REFEf 

IE  STUDIES 

Step  Input 

p*   (-100) 

P|  (755) 

c  (p*) 

C  max 

v=0,   w=0 

-100 

755 

0 

33220 

v=0,   w=10^ 

-114 

870 

18 

32500 

v=10 fo,   w-0 

-98 

750 

306 

33610 

V-10#,    H=»10# 

-102 

850 

299 

33700 

Table  A13.2  NOISE  CHARACTERISTICS. LINEAR  SYSTj^STErjffTJT 


-481- 


No. 

%v 

%\i 

Pj  (-100) 

P|  (755) 

C(p*) 

C  max 

1 

0 

0 

-100 

755 

0 

6999 

2 

0 

1 

-100 

755 

0.3 

6969 

3 

0 

10 

-106 

775 

19.7 

7470 

4 

0 

100 

-112 

1050 

268/4 

8182 

5 

0 

200 

-150 

900 

6353 

16390 

6 

1 

0 

-99 

755 

1.7 

693  2 

7 

1 

1 

-97 

750 

2.2 

6973 

8 

1 

10 

-88 

710 

24 

6336 

9 

1 

100 

-110 

IO50 

3396 

8645 

10 

1 

200 

-88 

670 

6423 

14240 

11 

10 

0 

-92 

770 

281 

7303 

12 

10 

1 

-92 

770 

246 

7069 

13 

10 

10 

-104 

805 

324 

7139 

14 

10 

100 

-116 

555 

19^8 

,14340 

15 

10 

200 

-150 

940 

13370 

27820 

16 

100 

0 

-80 

555 

23400 

32090 

17 

100 

1 

-58 

650 

22570 

26140 

18 

100 

10 

-150 

700 

29150 

43040 

19 

100 

100 

-112 

1055 

30740 

37670 

20 

100 

200 

-150 

960 

27150 

42140 

21 

200 

0 

-120 

900 

102100 

112200 

22 

200 

1 

-110 

560 

77750 

90740 

23 

200 

10 

-150 

560 

74650 

94440 

24 

200 

100 

-150 

560 

07700 

118300 

' 

25 

200 

200 

-58 

580 

64980 

69930 

Ti 

ible 

A13.3 

NOISE  ( 

3HARACTERIST 

ECSjLINEAR  SYSTEM.  STAIRCASE  JN 

put 
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Simulated  Impulse 

p*  (-100) 

P*  (755) 

C  (£*) 

C  max 

v=0,  w=0 

-100 

755 

0 

10^00 

v=0,  w=10?£ 

-94 

775 

18 

9807 

v=10^,  w=0 

-104 

785 

293 

11010 

V^IOJS,  w«10# 

-89 

720 

264 

10490 

Table  A13.4  NOISE  CHARACTERISTICS,  LINEAR  SYSTEM. 
SIMULATED  IMPULSE  INPUT 


Sinusoidal  150  sec. 

p*  (-100) 

P£  (755) 

C  (£*) 

C  max 

v=0,  w^O 

-100 

755 

0 

2488 

v=0,  w=10^ 

-96 

755 

30 

2407 

v=10#,  w-=0 

-94 

765 

298 

2529 

v=10#,  w»10# 

-100 

745 

286 

3082 

Table  A13.5  NOISE  CHARACTERISTICS,  LINEAR  SYSTEM, 
SINUSOIDAL* 150  INPUT 


Additional  studies  were  made  using  the  linear  vehicle  in  equation 
A13.1  and  a  nonlinear  absolute  square  model  to  simulate  the  fitting 
of  a  nonlinear  model  to  linear  data.  The  contours  of  these  runs  using 
a  sinusoidal  150  second-period  input  are  shown  in  Figure  A13.5  and 
show  that  the  best  nonlinear  fit  for  equation  A13.1  is  given  by 
equation  A13.2,   The  noise  characteristics  of  the  nonlinear  model  for 
linear  data  are  presented  in  Table  A13.6, 


4507  x  -  -19.7  x  |x|  +  645  u  |u| 


A13.2 
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Lin.  Sys. , Nonlinear  Model 

Pj 

P* 

C  (p_*) 

C  max 

v=0,  w=0 

-19.7 

645 

116 

3533 

v=0 , w=10# 

-19.4 

640 

173 

3558 

v»10#f  w=0 

-18.5 

660 

339 

3423 

V=10%,  W»10# 

-21.5 

620 

471 

3488 

Table  A13.6  NOISE  CHARACTERISTICS,  LINEAR  SYS1 

KONLINEAR_  MOJDEL,  SINUSOIDAL  J50  I \ 


The  contours  a.nd  tables  in  this  appendix  show  that  the  sinu- 
soidal input  function  is  the  best  of  those  inputs  tested  for  identi- 
fication using  model  reference  contouring.   In  addition,  the  noise 
characteristics  indicate  that  the  10%  v  and  w  noises  generally 
permit  about  5%   parameter  identifications. 
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CONTOUR  1 

*••••*    INCREMENT     IS  0.5000000E 

0.555CC0CF    03  0.  805COOOE    03  0. 1055000E    04 

0.56E    03       0.66c    03       0.76E    03      0.86E    03       0.96E    03       0.11E    04 

•    ccs         a.*.***....  ■*»  •   •  •    •  *  .  .  .   *      ■••»,-•■».•»     '»»,,'. ■....',-..    •    «  * 

-0.150E  03*  5  5  5555444  4  444  44  3  3  3  333  33  3  3  3  3  2  2  22  2  2222  222  22  2222  2  222  2?  < 

■C.148E  03*5  5555  544444444433  3333  333333222222222222222222222222* 

-0.146E  03*5  5  555  4  4  44444443  33  333  3333332222222222222222222222222* 

-0.144E  03*55  55444  44444433  33333333332222222  2222222222222222222* 

-0.  142F 

-0 

-0, 

■Oc 

-0.134E  03*444444444  33  3333  33  333  2222222222222  22222222222222222 

-0. 132E  03*444444443333333333322222222222222222222222222222222 

-0.130E  03*4444444  33  333333333222  2222222  2222  2222222222222222222* 

-0.128E  03*4  44444  3  33333333  33  2222  222222222222222222222222222222 

■0.126E  03*44444  3333  333333  3222  222222222  22222222222222222222222 

•0. 124E  03*44  444  3333333 J3322 222222222222 222 2222222222222222222 

-0.122E  03*4  44433333  33  33322222?2222?2?222222  22  2222  22  22222  22222  * 

-0. 120E  03*444333333  33332222222222222222222222222222222222222; 

-0.U8F  03*4  4  3  33  33  33  33  3222  2  22  2  2  22222222  22222222222222222222222* 

-0.116E  03*33  333  3333  332  222  222222  222222222222112  222222222222222 

■0.1 14E  03*3  3333  3333322  222  22222222222  222221112222222222222222i 

•0.112E  03v-3  33  3  3  33  33  2  22  222222  22  2  2222222  221  11222222222222222222* 

■0.110E  03*33  3333332222222222222  222222211122222222222222222222* 

■0. 1C8E  03v 333 333 3 22 222 222 22 2 222 222 22 21 11 2222 22 2222 22 222 2 2222  3v 

■0. 106E  03*33  333  2222  222222222222222211112222222222222222222233* 

■0.104E  0  3*33  3  32  2222  2222  22  22  2  2  22  22211  112? 2 2 22 2? 22222 2222 223333 v 

-0.1 02E  C 3*3 33 222222 222222 2 2222221 11122 222222 22222 2222 2233333 

-0.1 OOE  03*33  222  22  22  222  22222222211112222222222222222223333333 

-0.980 E  02*22  222  2222  222  22222  221111122  2222222222222222333333334* 

-0.960E  02*22222  2222  222222222111122222222222222222233333333444* 

-0.940E  02*22222  22  2  22222222211112222222  2222222222333333334444 

-0.920 E  02*22  22222  22  222222  211122222222222222222333  333334444441 

•C.900E  02*2 2 222 22 22 222 22111 1222 222222222 222 2 2? 3333 334444445 55 v 

-0.8  30F  02*22  2  2222  22  2  222111222  22222222222222333333344444455555* 

-C.860E  02>:  2  22  22  22  22  2  22  112  2  2  2  2  22  2  22222  22  223  3  333  334  44  4  44  5  5  55  5  66* 

-C.840E  02*2  2  2  22  2222  221122  222  22  2222  222223333333444444555  55666 

-0.820E  02*222222  2  22  222222222  2  22  2  2222233  33  3333'.  4444555  556o6677 

-0.8COE  02*22222  22  22  222  22222  2222222223333333444445555666677771 

-0.7  80E  02*222  22  22  2  22  22  2222  2222  2222  3333  3  334  444455  556  6667777888* 

-0.760E  02*2222222  22  222222  222222233333334444455556666777838999* 

-C.740E  02* 22222 2222 2222222222233333334444455556666777888999A 

-0.720E  02*22 2222222 2 222 2 2 222 2333 33 3444445 5 556667777888999AABB* 

-0.7 OOE  02*  2222  2  222  2  2  22  2  22  22  33  33  33444445  5  5  56667  77  88  39  9<>  A  A  ABBCC* 

-0.680E  02* 2 2 222 22 22 222222 3333 334444455 55666777838909 AA88BCCD0V 

-0.660 E  02*2 222 222 2222 22333333444445 5 56666 7  77 88899AAA33CCD0E EF- 

-0.640E  02* 22222 2222 223333 334444455 5666677788999 AABBCCCOOEEFG \ 

-0.62OE  02*2 2 222 22 22 23 333344 44455 566677788899 AAABBCCDDEEFFGHHJ 

-0.600E  02*22222222333334444455566677788899AABBCC00EECF GGMJJk 

-0.580E  C2*222222333334444555566677788999AABBCC0DEFF3GHJJKKLM I 

0.56E    03*#o!66E*03#*0.76E    03      0.86E    03       G.96E    03       0.11E    C4 
Figure  A13.1     LINEAR  SYSTEM.    NO  NOISE.   STEP  FUNCTION  CONTOURS 
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C'.t  NTOUR         1 
*...»*     INCREMENT     IS 
C»555CCC0E    0  3  0.8C50000E    Ci  Q,  I  (4 

0.56E    03      0.66E    03      0.  ?6E    33      0.86E    C  3       C.S6E    03      C.1H 

5'"  o  c   ©  o    •'  ••••*•••    >  *  •  o  c  o  *  o  o  c  o  * :  o  o  «.  o    *  >  c  e   »  •■  .. 

0.  150E  03*5555555544444444433 3  $3333333332222222222 222222J 

0.148E  03*5555555544444444433333  333322  2  22  ^22  22  >  I  2  2 

0.146E  03*5555555444444444333333333333322222;     ..     2222222; 

6.144E  03*555555444444444233333333333222222222;  22 

0.  14  2E  C3*55 5 5 544444444433333333333322222222 222222222 22222222 

G.  140E  03*555554444444422233333333322222222222222;  22 2222 

0.  133 E  03 *5 55 54444444 4 3 33332 2 333 332 22 222222 2 2 2 22 2 22 22 22 2222 

0.  136E  03*555444444443333333333332222222222 222,  1222222222* 

0.134E  03*55444444443232323333322222222  222222 

C.  13 2 E  0  3*444  44  444  4  33  33  3  3  3333322222  222  22222  2  2  2222  22  2  2  22  2 
0.130E  03*4444444443323222333 

D.  128E  03*4444444433323232222222222222222;  2222222222 
0-  126E  03*4444444333333333322222222222222222  22* 
0.  124E  03*444444333333323  32  22222222222222222                                          22* 
0. 12  2  E  0  3 *444 44  3  333  3 33 3 3 322 22 222 222 2  2  2  2 22  22  22 2  2 2  2 22  22  22 2 2 22 2 2* 
0.  120E  03*444433333333332 2222222222222222222222222222222;  . 

0 c  1  i  8 E  0  3  *4 44  2  2  3  5  3  3  3  332  2 2  22 2222222222 222  222 2 2 2 22  2  2 222 222222 22* 

0.  116E  03*44  3  33333333  22  22  2222222222  22  222222  2  22  22  : 22 2 2 22 2222    2 

6.114E  0  2*2332 333 3332 22 2 2 22 2 22222222222222222 '22  22222 2222222, 

0 •  1 1 2 E  03*333333332222222222222222222222222222222222222  222222* 

0.  110 E  0 3* 3 33 2 3 3 33222 2222222 2222222 22222 2222 2222 2 222 2 2 22 22223* 

0.  10 8 E  02*2  323323  2222  222  2  222222222222  2222222222222222222223 

0.  106  E  03*33333  3  22  22222  22222  22222  22  22  222222  2  22222222  2  22  2  23333* 

0.  1J4E  0  2*2  332  3  2  2222  2222  2  2222  222  22112  22222222  2222222222333333' 

D.  1C2E  03-3  32322222222  2 .2  2  2  2  2  2  ?  ?  2  1 1  1122  22222  22222222222333  33  3  3" 

LlOOE  03*333222222222222222222111122222222222;    !222;  >34' 

D.980E  02*2322222222222222222211122222222222, 

C.960E  02*222222222222222222illi222222222222222 

JS.940E  (  2*2  222  222  2222  2  2  222  221122222  22222222222222  2  22  - 

C. 920E  02*222222222222222 22122222222222222222233 33333444444 

D » 9 0 0 E  02*2222222222222222222222222222222222333333344444455 

0.880E  02*2222222222222222222222222222222233233 

Co  860E  0  2  ;2  2  22  2  2222  ?222  22<.22  2/22222  22  2222  333  ;3.>v    .,-•,(  53  i;t:v.6^; 

D.840E  02*222222222222222222222222222223223333'  455!  >67* 

0,  820  E  0  2  '■■  2  2  2  2  2  2  2  2  2 2  2  2  2  2  2  2  2  2  ?  2  2  2  2  2  2 2  2  3  2  2  2  2  3  3  4  4 4  4  4  5  5  5  5  5 6  6  6 67  7  7  • 

C.  8C0E  02*2222222222222222222222222333333344  55  56  666777*3  6  ■» 

0.76CE  C2*222222222222222222222223323333444445f  6667778889* 

0.760E  02-22  72222  22  ;  2  222222222223?  3333n-t- 

0.74OE  02*2222222  222222222333333-  77778 

0.  72 0E  02*22  2  2  22  2  2222  2  2  22222333333444445  55566667  71  ■    I  ' 

0.7*.  OF  02*22222222222222223333334444455556  >667  399AAeBfii 

0.68  0E  0  2*22  2  2  2  22  2  2  2  222  22  2  3  3334444455  5566667 77E 88 99AAABBCCI >C0-V 

0c66  0E  0  2*222222222223333 3 334444455 556667778 88999 AA6BBCCDDEEF* 

&.640E  02*222 222 222333 3 333444445555666777888999AABBCCCDEEFFGG* 

0.620E  0  2  N2? 2 22 2 23333 3334 444455 5566677788899 A A 3B8CCDDEEFFGHH J* 

0.  600E  02*2222232322334444555566667738899<  EFFGGHJJKL* 

0.  580E  02*2232333334444  4555 566677788899AA6BBCC0E  cF^GhJJKKL'-'^- 

*C«««*0»»«*»««**»»«     •*••••*••••*••     03l0C     3    «     '••••*••••'• 

0.56E    03      0.66E    03      0.76E    03      0.86E    03       <20cbl    C3      CUE    04 
Figure  A13.2     LINEAR  SYSTEM,    NO  NOISE,    STAIRCASE  FUNCTION  CONTOURS 
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•    O    9    U 


COIMTOUK  1 

INCREMENT     IS  101     02 

0.555OOC0E    03  3.   I    |         ICE    03  ,1C55! 

0.56E    C3       0.66E    03       Oo76E    03       0.86E    03       i).<  D.lll 

-0.150E  03*6  66  6666  5555  5  5  44  44  4^44^  2  33  3  23  i  3  —  3  •!  33  <  3  y-  3: 

-Co  148E  03 ':6666666  555553  V>  Vt- v. '»';  i  3  3.- .'j  52  ^;4 

-0» 146E  03*6666665555554444444433  3333333333333333 

-0»144E  03*6666655555544444^4433333333223223222232332323333 

-0«  142E  03*666655555544 4444443333333333  333333333332 

-0.140E  03*c6665555544444-»442223333333333J22222222223323  i; 

-0.13RE  03*6665555554-444444333333333333222222222       222233332 

-0.  136E  C-  3-66  5555554444444  22  3333323 

-C.134E  03*665555544444442223333  J33.  -  2222J 

-0o132E  03*555555  4444444  3333  33  33332222222222222;  22222  :         : 

-Co  1  3  j  E  03  ■*  5  5  5  55  4  4  44  4  4  4  3  2  3  2  3  3  3  333  2  2  '!  2  2  2  2  2  22  2  22 

-0.128E  0  3=555  5  5444444  3  33  3  23  333  '22  2  7.;. 

-0.  U6E  o  :5 3 55 4 44444333  3 333 332  2222222  : 

-Oc 12 4 E  03*55 5 44 ^4^4  33  3  3 3323 3 22 22222 22222 2 22 22; 

-0« 122E  03*555444443 3333332322  22  22222222  2222  2222  22222  2  23     3  -  J 

-Co  120 E  03*5  5  4  44  4  44 3 3 3  3 3  33  22  2222222222222  222  222222222223333332 

-0.  11 8 E  03*444444  4  3  3333  3  3  22222  2  22222222222222  \  12  2-223332 

-0.  116E  0  3-<  4  444  4433333  3  322  22  2222222222222  2222  2  22233  233333* 

-0. 114E  02*444443 3333333  2  2  2222222222222222222222222 22223  34* 

-0c 11 2 E  0  2 '44444 3 333333222 22 2222222222222222222222222 2 2233334 

-to  110E  C3*<444433333332222222222222222222222222222222233333444* 

- 0 .  1 0 8 E  03 '444233333322222222222222222222222222222223333333444* 

-O0IO6E  D3*444 3  33 3  33 22 2 2  2 2 22 22222222  222222  2222 2222233 2 23 224444* 

-0.  10  4F  0  2*44  3333  3  32  22222  2  22  2  222222222  222222  2  22222333333344444* 

-0.1O2E  03 ^33  3 3  3 3 3  3 2 2 2  22  2  22222 2222  222  222 2  222  222222  3 222 32444  • 

-G.1C0E  03*333333322222222  2222221112222,  .333' 

-  C  0  98  0  E  0  2  -J  3  3  3  3  3  3  2  2  2  2  2  2  2  2  2  2  2  2  2  2  1 1  i  2  2  2  2  2  ?.  2  2  2  i  2  3  3  3344 

-Co960E  02*23333322222222222221U2222  ;22222  !  ' 

-C.940E  02-2333322222222222222222222222222222; 

-0.920E  02*33332222222222222222222222222222233233  b* 

-C. 900E  0  2*33  3322  222  2  222222222  2222222222222  333  32  V 

-C.880E  02';333222222232222222222222222:i222333333  >-»55556< 

-Cc  360E  0  2  ^3  3  3  222 12212  22  2  2  2222  2222  222  22223  3333344445  5  5  56666777-* 

-Co  84DE  0 2 -2332222222222222222222222222333333444445555666777 

-C.820E  02*33222222222222222222222222233333344 

-0.800E  02^3322222222222222222222222332333444  55566671 

-C.  780E  02  :33  2  22  2  22222  22  2222222  2223  333333+444  !  •'•~?77  ' 

-0.  760 E  02*33  2222222222222222222333333  344 '1  445  5  566667  77  E ! 

-C.740E  02-332222222222222222233333 

-C0723t  02*2322222222222222232333334444  ICC 

- 0 • 7 0 0 E  02*3322222222222233333333444445555666777e3699AAA 

-C.680E  02*333222222223333333334444455556667778889 

-0. 66 0E  02*233 23 3 3 3333 2333 2334444455556666776 68999AABBCCDDI 

-0.640E  02*333333333333 333344444555566667788899AAABBCCCOEEFGGH  ; 

-t,  620  E  0  2*233323  3  3333334  4 444455556667  7788899  A  A  ABBCCCCEFFGGHJ  J  : 

-0.6C0E  02*^3^33"3334444^<4555566677768899AABBBCCI  HJJKl* 

-0, 53  JE  C2*333333344444445555666677788899AABBCC0OEEFFGHHJKKL> 

"I  o  «  •  o  * '  o  c  o  o  *;  •  o  a  o  "  c  I  »  *  *  o  o  ■  o    '  o  o  o  «  + *  ■>  p  *  *  o  o  o  o  *  o  o   ■  I  r    I  I 

0.56E    C3      0.66E    03      0.76E    03      0.86E    03      C.96I  111 

Figure  A13.3     LINEAR  SYSTEM,    NO  NOISE,    SIMULATED  IMPULSE  FUNCTION  CONTOURS 
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CONTOUR         1 
<-.o..^    INCREMENT    IS  0.5000000E    02 

0.5550000E    03  0.8050000E    03  0.1055rOOf 

0.56F    03       0.66E    03       0.76E    03      0.86E    o^       0,961     03      0.111     ' 

-0.1 50F  03 *BB A A A9 98887777666655 5555 55444444445555555666667771 

&.148E  03*RRAAA99338777766665555555t-4't^44445555555'  '  '  i 

-0.1  46F  03-RRAA9998877776666555555444444444444455555;-  777RB' 

-0.1  44F  03 -A A A99  9RRR7 776666 555 5 5444444444444 44445 5 55 5 566677 7 

-0.142F  03* AAA998 8877 76 6 66 555 55 44444 444444444 4444 555556666 777; 

-0. 140 E  0 3? A A99Q8 87  7 7666 65 5 5 5444444  444444  444 44444455 55666677 7 

-0. 13RF  03*AA  9988777666655 5 54444444433333344444444555556667778* 

-0. 136F  03*999888  7776665  55  544444443  333333333  4444444555566677" 

-0.  1  34F  r,-3  !<9998R7776665555444444333333333333344444455556667778* 

-0. 132F  03*998R37766655554444433333333333333334444455556667778 ' 

-0. 130F  03*998877  7666555444443333333333333333334444455566677' 

-0. 1 28F  03*88877766655544444333333333333333333344444555666777 

-0.1 26F  ^3*888776665554444433333333333333333333 

-0.1 ?4F  03*887776665554444333333322222223333333344445556667788* 

-0.122E  r 3*  8 87766  65  5544  443  3333  3 22 2  2 2 2 2 2? 2 2  333  3334 4445  55 666  7  7  : 

-0.1  20 F  03*7 7 7766 55544443333 33 222 22 2222222 333333444455566677( 

-0.118F  03*777666555444433333222222222222223333344445556677788 ' 

-0.116F  03*777665  554444333332222222222222223333344445556677888* 

■0.  114E  03  *776665554443333322222222222222223333344445556677889* 

-0.1 12F  03*77665  55444433332222222222222222223333444455666778 

-O.IK'E  ^3^7  76  6  5  5  5444  333  33  22  2  2  2  2  22  2  22222  2  2  2  2  33  ^4  44  555  66  7  77  88  9* 

fep.  108F  0  3'-  66665544443  3  332  3?222222  2  2?  22  2222  333  33  A 44  55  566  77  8  8^9  l 

-0.1 06F  03*666555444333322 222222222222222223333344455666778899 

-0.1 04F  03*66655544433  33  22222222222222  2222233334445556677788     ' 

-0.  102F  03*6665 5444333322222222 2222 222 2222233334445556677B899A 

Jp.lOOE  0  3*665554443333222222  222122  2222222233334445566677889 

&.980E  02*6655  5444333  322222222  2122  22222223333444  55566778899/ 

-0.9  6'iF  02* 665 5444333322 2222222 212 22222222333344455566778899AB* 

-0.9  40  F  02*6  65  544433332222  2222  2222  2  222222  3333444  555  66  77  8  89QAAB* 

-0.92 OF  0?  * 55 5 5444333 322 22 2222 22222 222 22233334445556677889AABB* 

5&.900E  0  2*  55 5 54443333 22 22 22 222 2222 222 22 3333444 555 66778899 AABC* 

-0.8  80F  02*55 5 54443333 22 22 2222 22 2 222 222 3333344455 66677889AABBC* 

-0.86 of  0  2* 55 5 5444333322222222 2 222 222223333444555 66778899 ABBCD* 

-0.8  40E  o?-55  5  544433  3322  22  22  22  2  22  2  2  222  33  33444  5r>566778  899AARC 

-0.P2OF  0  2* 55 5 5444333 3222222222222 222333344445566677889 A ABBCDD* 

•0.800E  0  2* 55 5 5444333332 22 222 22222 223333344455566778899 ABBCDDE* 

6.780E  02*55 554443333 322222222 2223 333 33444 55566778899AABCC0EE* 

-0.76OF  0  2     55  5  54443333  33  2?  22  ?22  22  3  3333344455566777889AABBCDI 

-0.740F  02*  555544443333333222233 333 334444555666778899 ABBCDDEFG' 

-0.  720 E  02* 55 55 44443333333333 33  33  333444455566677 fl B99A 3  rU. C  HE  f f G* 

-0. 70OE  02*5555544443333333333 333 334444555666778899 AABCCDEFFGH* 

-0.680F  02 * 66 5 5544444333 3333 *3 3 33 444 44 5 55 66677889 9A ABC CDFEFGH J* 

-0.66OF  0?-<665  5  554444433  3333  3344444  4  5555666778899 A  ABCCDEEFGHH  J* 

-0.6  40F  02*66 55 554444444444444444445555667778899 AABCCDEEFGGHJK* 

-0.62DF  02*666555544444444444444455 556667778899AABCC0DEFGGHJKL* 

5O.6OOE  O 2^6666 55 55 544444444445 555 5 5666777 P899 A ARCC DOE FGGH J ► 

-0.58OF  02 -''66666  55  5555  544455555  55  566677788G99A ABCCDEEFGOHJKL  ■ 

0.56E    O3*7.."66F*03,*O.°76E    03       0.86E    03       0.96E    02       CUE    04 

Figure  A13.4     LINEAR  SYSTEM,   NO  NOISE,   SINUSOIDAL  150  SDJOND  INPUT  CONTOURS 
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CONTOUR         1 
*••••*    INCREMENT    I S  0. 50  I     02 

0.555CC00I       13  0.80500  )0E    03  | 

0.56E     03       Oo^ob.     )3       )•  76E    03       0.8bE    '  HI 

"'     '    '    '        •••«     "••  •  *  '    »  o  o  B*  0  •   o  •  -o  •  „   o  *•  -    ,  9  '•  o  u  o   C    J  o   c  «,   "    o  c  a  o  * 

-C.222E  02-222222222222  !222 23333  3444455566667738899 

-C . 2 1 9 E  C2* 22222222222222 2 222222333334444555666677i 

-0.217E  02-2222222222222222222223333344445556666776        . 

-0. 214E  02'-222222222222222222222333334444555666777888  VBBCO 

-0.212E  C  2-  22222222222222  '.  222222333334  *4455566677788899AAABBCC  « 

-0.  209E  0  2'-  2  2  2  22  2222  2  2  22, 2/. '22222333 3 34  4  44  5  3  56  6677786  B9  >A 

-C.207E  02^222222222222222222222333334444555666777  •'  '.C  • 

-0.204E  02"222222222222222^22222333334444555666777889'  C  : 

-0.  20 2E  0  2--:22  2  222222  12  2  222     >2  22  233 3334444 5 5  5666777 889  J 9  '. 

-G„I9?E  02-2222222211222222222223333344  156667778899  r.  • 

-0.1 97E  02*222 2222211 i 22 2  2>2,::;     i 

-0.  194E  ■  ;     222222? >112222 

-C.192E  02  :22222222212222.^  22222333344445  67773* 

-0.189E  02*222222222222  !222333334444555666771 

-0.18  7E  0  2-2?.  2  2  22  2  2  2  2  2  2  2  2  2.!  2  2223  3333  44445  5566*  777  38999AAB3CC0D* 

-0. 184E  02:222222222222222222223333344445556667778899 

-Co  IS  2E  02 -222222222222222222223333344445556667768399 ! 

-0.  179E  02 ^22222222 222 2 2 222222233333 44455556667738899 

-  0  • 1 7  7  E  02-22222222222222  2  222223333344455556677768999 

-0.  17<rE  02'  22222222222222222222333344445556667778  8  ^  3AA3BCCOI 

-0o  17  2E  0 2* 2  2  2  2  2  2  2 2 2  2  2  2  2  2  2  2 2 2 2 3  333 3444  45  5  566 6 7 778 899A  A8BCC 

-0.169E  C  2*2222222222222  22. !222333334444555666773fc  399AABBCC0DE 

-C.  16  7c  0  2^'22  2  22  2  22  2  222  2  2  22222333334445555667773899  ?AABBCC0 

-0. 1&4E  02*2 222222222222222223333 34444555666777 18  •  >AA  I  F* 

-Co  152E  02V-2222222222222222223333344445556667778! 

-Gol59E  02^2222222222222222223  h445556667"i  >AABBCCC 

-C.157E  C2>22222222222222222333333444555566771 

-0.  15  4E  0  2^2  22222222  22  222  2,  23  3  33344445 556667778399 AABBCCDDEtFf 

-0.  15  2t  0  2    2  2222222222  2  22  2. '  f  3  3  3  3  3  44  \  4  5  5  56  66  77  8  6  oc,  9AAB3CC  DDEEf 

-0.149E  32-33222222222222?  2333334444555566777* 

-G.147E  02":33  22222^22222,:2  ■  33533-t444555o:>67773^  EEI 

-0.  14  4E  0  2 '-333222  2  22  22222  2  :  3  333344445  5  566677  368  99AABBCC0DE  l 

-0.  ]42l  52*333222222222223*33334444555566  ^BBCDl 

-C.139E  02*3333222222222332  3  33344445556667778  '   IBCCDD 

-0.  13  7  E  0  2-' 3  33  32  222  22  2  23  3  3  3  3  33444455  5  56  66773  8  89  9A  ABBCCDEEf  I    i 

-0.  134E  02'-  333333222233333  >3 3344445 556b67778899AABBCCDCEEF< 

-0cl3  2E  02^332223233233333  ?  334  44455  556  66  77  3  3  899AABBCC  GGi'J  : 

-0ol29E  02"3333333333 333 33254444455566677     I 

-0.127E  02 '233233333332323 5544445555666776* 

-0,  124E  02-233332333322335  >  <444455566677788999AAI  3C0DEF.I  FGH  I. 

-0,  12  2  E  C2-* 22 33  333  33  333333  ',-44455  5  5  6o6  777c:8  9  9AAB8CCCCEFFGGHJ JK* 

-0.  119E  02*333333333333334  <  ..44455566677788999AA6BCDDEEFFGHHJKK* 

-C.117E  02*44  3 2 3 33  3  3  33234 4 4444  55 556667778899 A ABBCCDDEFFGGHJJKL* 

-0.  11  4E  02* 444  2 33 333 33 44444 -+45 5 5566677 78«  CD0EEFrG>  l!J-vLL- 

-C112E  C  2  -44444  3  2  3344  44  44  44  5  5  5  56  6  6677  6  8  899AABBCC0DEFFGGH  J  J     I 

-G.109E  02*444444444444444455555666777*  0  jEEFGl1<^  JKL  i      - 

-0, 107E  02*4444 \  V.444^4444! 5 5 5566677768899AABBCCC DEFFGHHJKKLI 

-*  •  «   o  o  *   o  o  o  c  ~';  o  e  o  o   v  «>  o  o  o  ^  ©  o  o  o  lt  o  a  o  c       c.    ct   xcec  o:    jooo^.ooo"5 

0o56E    C2       C.66E    03       0.76E    03       0.86E    03       0.<*6E    03      CUE    ■ 
Figure  A13.5     LINEAR  SYSTSM.   NONLINEAR  MODEL.    SINUSOIDAL  150, 

NO  NOISE  CONTOURS 
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APPENDIX  A14 

CHAFi'^H   P4     EKE  SINGLE  DEGRWH  OF  FrifWDOM   PfiOGHAjW^DJUI^nM,' 

C  PROGRAM    FOP     KALIAN    FILTER    STUDIES    IN    A    SINGLE    DF.GPEL 

C  Of    FREEDOM    WITH    ONE     ST  AIL-    *NO    TWO   PARAMI 

REAL    M 

DIMENS  I  ON    ZS(1  D  f:  ),US(188),TS(188  ),XV(.u,  i) 

DIVFNSJ  ON    A(9),e (3)  ,XHT(3) , XBAR (3) ,HZ<3  ) 

DIMENS  1  ON    EHT(?)  ,EBAR(9  )fEGAIN(3) 

DIMENS! DN   X  r>L<?76) »  APL(376)  ,BPL (376 ) 

DIMENSI  ON    E  PX1376)  ,  EPA(  376)  ,EPB  (376)  ,FPl  (]  ?  )  6) 

COMMON     /RKI  /D 

COMMON     /REf/G 

COMMON     /UFUN/HV,  TP, TPP , to 

COMMON    /NO]  SE/AM,S 

COMMON     /STOP    /OX ,DA ,DB,DEX . OLA  rDEBtTSC 

NDN  =  ! 

IXV  =  ! 

IXW  =  11  1  1 

d=o.07 

nr    5    KDNC=1  tNDN 

G=0.00!  7 

DC    6    KGNO=l  tNDN 

HV=  0 . 5 

TP=100. 

TPP=200  . 

T0^0. 

AM*=0. 

S=l  . 

M=4  507.  0 

DX=1. 
DA=l./l  M 

DP=i./rM 
hex --: . 

DEA=1«  /  (EM*EM) 

DEB=1./ (EM* EM) 

CDZ=-I6  .7 

CNZ  =vrc;  .0 

AZ=CDZ/M 

BZ=CNZ/M 

TI  =  0. 

XI  =  0. 

C-l  . 

N-  I  8  6 

TSC=1. 

sc=o.  OTrr 

C  GENERATE    INITIAL    VEHICLE    DATA    WITH    NOISE 

CALL    RKNL(H,TI.XI,N,AZfBZ,C,ZS.US,TS.lXW.IXV) 

C  PL3T    INITIAL    OAT  A 

usc-o. 

NPL  =47 

KS=A 

DC    1    K»  it  NPL 

L=KS*K 
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XV  ( 
XV  ( 
XV  < 

cr\! 

C-H 
INI 
SET 

AND 
KST 
KFI 
K6= 
KFI 
SET 
XS1 
AST 
BST 
SET 
XHT 
XHT 
XHT 
SET 

ow= 

SET 

AND 
P=P 

0=C 

INI 

DC 

ft(K 

EHT 

CON 

3(? 

B(3 

SET 

EHT 

EHT 

EHT 

DEP 

HZ  ( 

HZ( 

HZ< 

PL  A 

NP= 

DO 

USV 

uz= 

US< 

DT  = 
CAL 
CAl 
CAL 
OCAL 


KJ =T 
NPL* 

2*NP 
TINU 
L  PL 
TIAI 

KM. 

STO 
=  1 
NC=1 

Kr,T: 
M^1  8 
IN  I 
=  1. 

—  _•>  1 

XHA 
III* 
I2)  = 
(3)  = 

EX  A 


MHT 


S(l  )  /TSC 
K)=US(L)+USC 
L+x)  =ZS(L  )  +  SC 
E 

OT(0  ,XV,NPL,  3,0) 
SETUP 

MAM    FILTER    I NCREMENT, STARTING    INDEX, 

&PINO    T.TEX 


KFINC 

9 

TIAL     STARTING    STATF    ESTIMATE 

.  2  /  M 

./M 

T(OJ 

X5T 
AST 
BST 
GEPA TED    NOISE    PARAMETERS 


SE    P  ARAMETER  SrO    FOR     VEHICLE    NOISE    H, 

OR    MEASUREMENT    NOISE    V 

D  Note:      P  a  R  used  in  Chapter  Ph 


r>    F 
W  *D  * 

■  G 
TIALIZE     AfB,AND    EHAT    MATRICES 
I    K  =  1  *  9 
)=0. 
[K)  =  0, 
TT';M  E 

)  =0 . 

)^C. 

INI 


T I  At      ERROR    COVARIANCES 

0.r 

20.  /  [M*MJ 

1500  ./(M*M) 

H    MATRIX 


111  = 
I  5)  = 
(9)  = 

INE 

1)  =  C 

2)=0  . 

3)  =  0  . 

C  F    I  NIT  I  AL    V  ft L J  E S    IN    OUT  PU T 

3 

3   K=1,NP 

=US { 1 ) 

U(TI  ,X1  ) 

1J=UZ 

H 

L    PR0P(DT,US,XHT,EHTtA»0,XBAR,EBAR,1  ) 

L    GA  IN(  EBAR,HZ,P  , EGA  IN1) 

L    UP  DAT  (  ZS,HZ  ,EB  AR.XBAR,  EGA  IN, XHT  ,EHT,l) 

L    ST  ORE (  XHT, EHT, TS, X  PL, A  PL, PPL, E PL,E PX,  E PA,  E nR,  1  . 


Z:Q-;_ 
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1KFTN) 

US  (3.  )  =  U 

c 

BEGIN    I 

on  a  t  i 

nv=  i :  - 1 

DT=TS(  I 

c 

PRO PAG A 

c 

THE    NON 

c 

MET  HOD 

CALL    PR 

c 

COMPUTE 

CALL    GA 

c 

UPDATE 

c 

UPON    MO 

CAL  L    UP 

c 

ST3RE    T 

c 

AND    FOR 

OCALL    ST 

IKFINJ 

4    CONTINU 

c 

PLr.  T    OU 

CAL  L    OU 

3    CONTINU 

0=0.017 

6    CONTINU 

D^C."7 

5    CONTINU 

STQP 

END 

sv 

TERAT10NS  FOR  F I LTER  ING 
=KB. KFIN 

!)-TS(NVI 

TE    THE    STATE     AND    ERROR    COVARIANCE    MATRIX    USING 

LINEAR    vgnEL    AND    AN    EULER    INTEGRATION 

FDR     INCREMENT    OF     TIME    DT 

OP(DT,US,  XHT  ,EHT  ,A,Q  ,XBARfEBAR,  !  I  ) 

THE    KALMAN    GAIN    MATRIX 
IN(EBAR,HZ.P,EGAIN) 

THE     SJfi  T  E    A  N  f)    E  R  ROR    C OV  A  R  I  A  NC I    '•'  A T R  i  X    BASED 
ST    RECENT    MEASUREME  NT 

DAT(  ZS,HZ»EBAR,XBAR,  EGA IN»XHT  ,EHT,I]  ) 
MESE     VALUES    OF    XHAT     AND    EHAT    FOI      LATER    USE 

PLOTTING 
ORE!  XHT,EHT,  TSt  XPLt  A  PL,  BPl  ,EPLtE  PXtEPA,  EPBt  1 1  ■ 


TPUT     FUNCTIONS 

TP  (  X  PLt  A  PL*  B  PL  ,  E  PL  t  E  PX ,  E  P  A,  E  PBtK  FIN  I 
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Slin 
01 M 

CC'-' 

x=x 

T=T 

A=A 

B=B 

UV= 

WV^ 

DO 

Tl= 

X=X 

T=T 

TS( 

uv= 

US( 

vv= 
z=c 

ZS( 

CON 
RET 
END 


ROUTINE     RKNL(H,TI,XIfN,AZ,BZ.C,ZS,US,TS,  IXW. IXV) 
ENSION    Z  5(1), US( LUTSU ! 

'•'  )N    /RKI  /D 

I 

I 
Z 

7 

UlT, 
'•>"  (  !  X 
?  II 
H*F  f 

+  H 

II)  = 
U(T, 
II)  = 

VlIX 
*  X-5-  0 
!I1  = 
TINU 
URN 


X) 
W) 

T,X,  UV,*  .B.WV) 


X) 
UV 
V) 

*vv 

7 
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REAL    FUNCTION   M  T,X  ,U,  A  ,B,  V  } 
NONLINEAR    ABSOLUTE    SQUARE    LAW   VEHICLE 
COMMON    fPEF/G 
F*  A  *  X*  A  BS(  X  )  +B*  U  *AB  S  ( U )  *  G*  VI 

RETURN 
END 
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REAL    FUNCTI DN   U( T,X ) 
STAIRCASE    W  !TH    2    ST  LPS 
COM  MOM     /UF  U  N/H,  T  P , T  PP , 7  0 


1F(  T-TP  )1.2  ,2 

1 

0=H 

RETURN 

2 

IF{  T-TP P  J  3,  4,4 

3 

U=2,*H 

RETURN 

4 

U=0. 

RETUr,f! 

END 
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SUBROUT  !Mr     PROP(H»UStXHTfEHT,A,  OfXBAR,EBAP.,  !  ) 

OIMENS1  ON    USU)»XHT{1>,  EH1  ll),A(l),  XBAR  (1),  EBAfl  (!) 

DIMENSION    EH9),E2(91f  E3(91  ,E4 (9  ),EJ(9) 

X=XHT(1  ) 

DC    3    J=l,9 

EJ(  J)  =  EHT(J  ) 

CONTINUE 

UV=US(  I  ) 

T1  =  H*FUN1<  XHT,UV) 

CALL    EFUNtA  ,EHT, 0,EltXHT,UV ) 

XRAR(l) =X*T1 

XBAR (?)  =XHT (2) 

XBAR  [?  )  ^XHT  (?) 

D°     r^    J  -  I  •  9 

EBAR  U5  =EJ(  JHE3  (J  )  *H 

CONT  ENU  E 

RETURN 

END 
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SUP 
DIM 

A(  1 

A(4 

A(7 

EB{ 

OEB( 

lAf't 

OEB( 

lAt4 

ER( 

EB< 

OER( 

1 A  ( 2 

EP( 

EB1 

EB( 

RET 

END 


ROUT 

ENS  T 

)-2. 
)=X( 

)  =u* 
!>=?' 
2)  =  r 
)*E< 
3)=-E 
)*E< 
<t)  =  E 
5)=2 

6 )  =  r 

)*E( 

7)  =  E 
8  ) '  I 
9)=2 
URN 


INE 
ON  A 
*XJ2 
1 )  *  A 
APS( 
.*{  A 
( 2 )  * 
5J+A 
13  J* 
6)+A 
B(2) 
,*(A 
( 6 )  >■■■ 
3)+A 
B<3) 
c('  ) 
,*(A 


EFUN 
(1), 

)*AE 
BS(X 
UJ 

( I )  * 

{ A  ( r. 
(7)* 
(AC. 
17)* 


(  A,EtCUEB,XfU) 
EUJ  iEB{  1),X(1J 
S  ( X  (  1 )  ) 

( 1 J  J 

E(l)  +A(4)*E(  2)*A(  7)*E  (31  )+Q 
)  +A(  1)  )  +A(2  )  *E(1  )  *A(8  )*E  13)* 
E(6) 

)  +A  {  9 ) )  +  A(3 )  *E(  1 )  +A <  6  )*E  <  2)  + 

P(9) 


(2)* E  (2  )  +A(  5  )  '  f  (  E» )  +  A  (  P  )  *  E  (6  J  ) 
{  A  {  r  )  +A  (  9 )  )  +  A  (  ?  )  *E  (  2  )  «-A  (  6  J  *E  (  r> )  < 

i  8 )  *  E  ( c; ) 


13)*E  (:!  )  +AU   )*E  (  6)+A  (9>*E  <c?5  ) 
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REAL    FUNCTION   FUN1(X,U) 

DIMENSION    X  til 

FUN1=X(  21*X ll)*ABS( X( I )  UX( 3)*U*ABS { U) 

RETURN 

ENP 
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SUBROUT  INE     GATN{  E»H,P,  EG) 
DIMENS1  ON    ECMMi)  »EG<1) 
C=H{M*WJ  )  *EU)  *P 
EGCl)-H{l)*E(l)/C 
EG(  2)=H(1)*E(2)/C 
EGC35-H  m*E(3)/C 
RETURN 
END 
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SUB 

DIM 

DO 

XH( 

CON 

&n 

EHi 

EH{ 
EH( 
EH! 
EHi 
EH{ 
EH( 
EH< 
RE  T 
END 


ROUT 
ENS  I 
i  J- 
J)  =  X 
TIMU 

1)  =  E 

2)  =  E 

3)  =  E 

4)-r 

5)-r 
o)^E 
7)--E 
8)  =  E 
9)=E 
URM 


INE     UPDAT  (7.,  H,ER,XP,  EGtXH,EH,  II 

ON    Z  (11 ,  H  (1 J  f  EB<  1)  t  XB<  1 )  ,  EG  (l),XH(l),  CH(  I ) 

S3 

bu )  *ro(j  i*{  z(  n-iu  i  )*xb(  i) ) 

B(l)  *{1.-EG( 1)*H(1) J 

B(2)-EG(2  )*H  (]  >*EB(I) 

B(?  )-EG(?  I*HU  )*EB<  1  ) 

H 1 2 ) 

B(?)  -EG(2)*H(3  )*EB(2  ) 

B(6) -EG(3)*HU )*EB(2) 

H{3) 

H(6) 

B(9  )  -EG(  ?  )*H  (  3  )  *i  n'(3) 
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SUB 
OOIM 

1EX{ 
C0M 

OT 
XP( 
AP( 
B^( 
EP( 
EX( 
EAI 
EB( 
N=  I 
XP( 
APi 
BP( 
EX( 
EA( 
EB( 
RET 
END 


1.  )  »  E 

M  ON 
(  I)/ 

I  )-n 

!  »*D 
I)-0 
I  )  =  D 
t  )  =  D 
I  )=D 
I  )^D 
+  K 
N)=X 
N )  =  X 

N)=X 

N5-S 
N)  =  S 
N)  =  S 

UP.N 


tEH, T,XP,AP, RP,EP,EX ,EA,  EB, I ,K1 
DiTCU  ,  XP(1  )  ,AP(  i  ),  RP(]  )  ,EP  11), 


ROUTINE     STGRECXH 
DN    XHUI,  EH( 
All)  iEBM  ) 

/STOR    /CX  ,DA  »DB,DFX,0[-A,DEP,C 
C 


H(l  )  /OX 

H  (.:)/  DA 

H(3  i  /DB 

CRT( ABS(EH(1  )/DEX)) 

0RT(  A?S(EH<5  ) /DEAD 

CRT( ABS<EH(9 )/DLB)) 
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SUBROUTINE     OUTP(XP, AP.BP.EP.EX, EA.TB.K) 

DIMENSION    XP{1I,APCI),BPC1J,EP(1),FX(1J  •EA(1),EB(11 

KV'=  K 

HO    I    I=lfK 

IL=I*L 

XP  (  I )  =  X  P (  1 1   J 

AP  i  I ) = A  P  ( 1 1  ) 

bp(  i)=bp(h  ) 

EX(  I  >=EXUt  ) 
EAI  I )  =■  E  A  ( 1 1  ) 
EB(  !)=EB(IL  ) 


?     CONTINUE 

DC    2    !  =  -.,K 

IK=I-*K 

KP=KV+I  *L 

XP(  IK)  ^XP(KP) 

A<M  IK)-  AP(Kn) 

BP(  IK)  =  BPIKP1 

EX(  IK)  =  EX(KPJ 

EA(  !K)=EA(KP1 

EB(IKJ=EB(KP) 

2    CONTINUE 

NS=0 

N=l 

M=2 

CALL    PLOT(N,XP,KtM,NSJ 

N=N+TL 

CALL    PL  OT(N  ,AP,K*Mf NS ) 

N=N+1 

CALL    PLOTIN  ,BP,KfM,  NS ) 

N=N+1 

CALL    PLOTCN  »EX»K,M,  NS) 

N=N+1 

CALL    PLOT(N,EA,K,M,NS) 

N=N+  I 

CALL    PLQT(N,EBtK,M,NS) 

K=KV 

KP*2*K 

WRITER  #10)  *P(KP),EA(KP),BP(KP)  ,EB(KP1 

lOOFCRMATt  MO,  2XVA*1  t  2X#E14.7  ,'     f    OR    -     'tElf 

• 

15X, fB-f t2X, E14.7,1     +    OP    -    » fE14.7) 

RE1  URN 

EMC 

Additional   Subroutines: 

GAUSS,    RANDU  -  Appendix  A4 
V,    H  -  Appendix  A12 

PLOT  -  Appendix  A5 
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APPENDIX  A15 

PUTTING  A  "WHAMMr  ON  NEGATIVE  K  IN  EXTENDED  KALMAN  FILTER 

The  E  matrix  in  the  propagation  equation  A15.1  for  an  extended 
Kalman  filter  should  never  "become  negative  for  a  positive  definite  Q 

E  -  FE  -:-  EFT  +  0.  A15.1 

matrix.   However,  in  many  cf  the  nonlinear  ocean  vehicle  simulations 
the  E  matrix  approaches  zero  very  rapidly,  and  either  computer  noil 
or  system  noise  may  cause  it  to  become  slightly  negative,  especially 
for  large  integrator  time  steps.   Equation  A15.1  usually  becomes 
completely  unstable  for  negative  E;  and  unless  some  provisions  are 
made  to  correct  the  situation,  the  entire  Kalman  filter  run  will  be 
program  interrupted  out  of  the  computer  due  to  exponential  overflows. 

The  following  Fortran  statement  A15.2  has  been  used  by  the  author 
on  several  occasions  and  has  saved  quite  a  few  Kalman  filter  runs 
which  would  have  otherwise  "blown  up."  The  use  of  this  simple,  fast, 

IF  (E.LT.  0.)  E  «  -E   ;   E  =  element  of  E  matrix  A15.2 

and  definite  correction  technique  is  almost  devoid  of  theoretical 
justification  and  may  be  likened  to  a  man  beating  on  the  top  of  his 
TV  set  with  his  fist  to  get  a  better  picture.   Sometimes  it  vrorks 
very  well. 
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APPENDIX  A16 
SUBROUTINES  PROP  AND  RKNL  WITH  RlLNGE-KUTTA  INTEGRATION 


SUBROUTINE    P^OP(H,UStXHT.EHT,A,0»XB/     .1  ,!) 

DIMENSION    LIS  C 1  )  ,XHTM  )  ,  EHT  (  1  )  ,  A  I  ]  >,XBAR(1),I      "   (  1  ) 
D I MF NS  TON    F 1  (  9 )  ,  E2  (  9 )  . F 3 { 9 ) f  E4 1 9 ) t  E J (     I 
1  =  1-1 

X=XHT( 1 ) 

no  3  j=i  ,  r> 
fj(  j)=    "M.n 

3  COM  [NUI 
UV=US( T ) 

T1  =  HJ'I     J     l(XHT.UV) 

CAI  I.     EFU   '(  '•  ,  EHT  .0,  El  tXHT.UV) 

XHT(  l)=X+Tl/2. 

UV-(US(  Ml)  +USI  I  )  )  /2m 

T2=H*FUN1  (  XHT  ,IJV) 

no   i   j=i  , 

FHT( J) =EJ (J)+E1(J) /2. 

1  CONTINUE 

CALL    EFUNU  ,  eHT  ,0,  E2  ,  XHT.UV) 

XHT(l)=X+T?/2. 

T3=H*FUM  (XHT  ,UV) 

on    2    .1=1 1  9 

EHT(  J)=EJ U)+E2( J)/2. 

2  CONTINUE 

C  ML     !  FUN(  '  ,  r:i'"'  iQ.  ~'>  tXHT  ,:JV) 

XHT(1)=X+T3 

UV=US (1  +  1) 

T4  =  H  =FIJN]   (  XHT  ,'JV) 

00  4    J=l,9 

EHT( J)=EJ (J)+E3U1 

4  CONTINUE 

CALL    E FUN (A, EHT  . 0, E4, XHT » UV ) 
XBAR (1 )=X+t Tl+?o*T2+2«*T3+T4) /6. 
XBAR(2)=XHT(2 ) 
X  R  A  R  I  3  )  =  X  H  T  (  3  ) 

no    5   J= 1 «  °- 

V-?t:i    l)={EHJ)+2.  ^?(J)i2o-r:(JH'-  Nil     (H/6. )+EJ(J) 

5  CONTINUE 

1  =  1  +  1 
RETURN 
END 
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SUBROUTINE    RKNL(H,TI,Xr,N,AZ,B?,C,7S,US,TS     T/"     iwi 
DIMENSION    ZS(l),US(l)fTS(l)  V1 

I        ION    /pk  r  /o 
H2=H/2. 


X  =  X  I 
T=T[ 

A  =  A  7 
R  =  R7 

on  ?    ii«i,n 

UV=U( T, X) 

WV=W( iv.) 

T1=H    c( 7 , X.UV.A, R , W ) 

TN=T+H2 

XN=XH Tl/2o 

UV=U( TN, XN ) 

WV=W( 1 XW ) 

T2=H  !-F  (TN,  xr<,  UV,  A  ,  ft,  WV) 

y  j=^  T2/2. 

UV=U< TN, XO) 

'.  V  =  W I  I  X  W  ) 

T3  =  H-  F ( TN.XG, IV, A, R,WV) 

TO=T+H 

XprY+T? 

UV=U{ T^,XP] 

US(  I  I  )=UV 

WV  =  ',-;f  T  XW  1 

T4=H    F(TO,XP,UV ,Ai Ri UV I 

X=X+(T1+ ?.> T2+2o«T3+T4 ) /6. 

T  =  T  +  H 

T  S (  1 1)  =  T 

VV  =  V(  I  XV) 

Z = C«  X  +  0    V  V 

7  S  (  1  I  )  =  7 

t  i  n  v:!'jf 

R  f-  T  I  ' 
ENO 
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APPENDIX  Al? 
SUBROUTINES  USED  IN  6  *  6  MODEL  REFERENCE  CONTOURING 

f       *******  ****  ****  ********  **************$***** 

C  SUBROUTINE     ScAl  R 

C 

C  PUR  POST 

C  TO    COMPUTE    SEA   TRIAL    TRAJECTORIES    FOR     A   GENERA!     C  C1  /  I 

C  VEHICLE    IN   ANY   SELECTED   COMBINATION   Of     6    DEGREES    OF 

C  FREEDOM  USING    AM    EULER    INTEGRATDf 

C 

C  SUBROUTINES    REQUIRED 

C  UINPT.OVMODiXDIST 

C 

C  DESCRIPTION 

C  SECTION   S     (C)  fM.N.  HAYES    THES  I  SfMI  T,1971,N  AME                   MEN! 

C 

q    i-.  $  *  *  *  *  *  *  **-  *  *  >;■  *  *  *  **  >:-  -;-  #  *  *  *  *  *  *  *  *  *  $  *  *  &  4  *  3)1  *  *  <■  %  *  .;.-  *  *  $  *  41  *  v- . 

Dt ME NS I  CN  T  (47 )  , U( 8 46)  ,  ZC28 2 ) ♦  ZN (28  2  ) 

DIMENSION   P(lltXll)  ,XN(11 

DU'ENSI  ON    0  (6),F  (6)  ,TST  (180  )  ,UST(180  ),US(18  ) 

DIM  ENS  I  CM    ME(?C)  ,AV (126  )  »XF  (126  )  ,IN(6),  NEC  27),  L  ii  ) 

DIMENSION    X  Z<6) ,XNZ (6) , XD(6 ),XDN(6)  ,  INV  (6) 

DIMENSION   LF(126  ),LP(l26)f  UK18  ),RV(  12) 

INTEGER     AV,XF 

COMMON     /OV/ME,AV,XFtINtNE,KB,L  *  KF-,LF  ,KP  ,LP 

COMMON    /SNO  IS/Q«R$1NV,RV 

CO^  MON     /STE  PS/TS T. U ST, U S 

COMMON    /SINTG/TZ,DT,T       • 

COMMON     /SUOUT/U  ■    • 

COMMON     /SZOUT/?,ZN 

COMMON    /TEST/EPS, EM  AX 

COMMON    /INTGR/NDT,KUtNST,KS  ,IONE,ITHRE,  KUA 

CAl  L    UI  NPT<  TST,UST.US,DT,TZ  ,T,U) 

DO    ?    KM  =    ,KB 

K=l (KM) 

XZ(K)=X(K) 

XNZ  (K)-XN(K  ) 

3    CONTINUE 

DO    14    J=1#KS 

XD  (  J  )  =  0  . 

XDN(  J)  =  0. 

14    CONTINUE 

DO    1    Jxl.NDT 

JU=  J 

DO    5    JA*1,KU 

UK  JA)  =  U(JU  ) 

JU=JU+NOT 

5     CONTINUE 

CALL    OVMOD(ME,AV.XF.PtIN.UI,NEtX,XNtXD.XDMtKB.I   ) 

IFCMEU  9).NE.I0NE)G0  TO    7 
DO    3    KM=1,K8 
K=L (KM) 

IF(K.LE.ITHRE)GG    Tj    8 
KUI  =KUA+K-I THRE-1 
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]  3 


1.2 


6 
10 


11 


UK 

CO?'' 
IF( 
JU  = 
DO 

uu 

JU= 

CON 

00 

K7  = 

K=l 

IF( 

X(K 

Z(K 

IF( 

GO 

XN( 

CAL 

ZN< 

IF{ 

TF( 

CON 

CON 

1  =  1 

GO 

1  =  0 

on 

K=L 

X(K 

xr'( 

CON 

RET 

END 


KU! ) =UI ( KUI )  +  X<< )*DT 

TINUE 

J.EO  .NOT  )G0    T0   7 

J+1+  (KUA-1)*NDT 

9    JA-KUA ,KU 

U)  =  U  HJA  ) 

J  0+  N  DT 

TINUE 

2    K  M = 1 ,  K  B 

J*NDT*(KM-3  ) 

(KM) 

ME(6  ).EQ  .DGD    TD    12 

)=X( K)+X  D(KM)*DT 

Z)  =  X (K) 

ABS<Z(KZ  )).GT.EMAX)GO    TO    6 
Tg   ? 

K)=XN(K) +XDN(KM] *DT 

L    XD  ISTt  IMVtRV,:.  tVN,  K,KS  ) 

KZ)  =  XN(K  )+VN 

ABS<  ZN<KZ)).GT.EMAX)GO    TO    6 

ME<9  J.EG.IJGO    TD    13 

TINUE 

TINUE 


TO    1  0 


11    Kf=l 

(KM) 

)  =X  2  (  K  ) 

K)-XNZ(K  ) 

TINUE 

U'ni 


KB 
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SUBROUTINE  UINPT(TS,US,UZ,DT,TZ,T,U) 

r      fa    *:.,->..-;  i:-J   v  ;■:.  v.. -::  .y  •/  ...  ,.-,., 

C  SUBROUTINE  UINPT 

C 

C  PURPOSE 

C    TO  GENERATE  A  TIME  VECTOR  AND  A  SET  OF  CL.MBI  NED-S  TEP- 

C    FUNCTION  INPUTS  FOR  A  GENERAL  OCEAN  VEHICLE 

C 

C    SUBROUTINES    REQUIRED 

C         f\CNE 

C    DESCRIPTION 

C         5ECTICN    6    (C), M.N.HAYES    THESIStMITt 1971 tNAME    DEPARTMENT 

C 

C  ' 

DIMENSION    TS(l)tUS(l)tT(l)tU( l)tUZ(l) 

CCMKCN  /INTGR/NCT ,KU,NST, KS,  IGNE, ITHRE,KUA 

T(1)=TZ+DT 

DO  5>  IT  =  2,NDT 

T( [T)=T(IT-l)*OT 

5  CONTINUE 
NS=NST/KU 
JU  =  0 

D3  1  IU=1,KU 

IST  =  NSM  IU-1) 

DO  2  IC=1,NDT 

JU=JU-f  i 

U(JU)=UZ(IUJ 

JS=IST 

DO  3  IS=1,NS 

JS-JS+1 

I  F  (  T  S  (  J  S  )  I  3 ,  6  ,  6 

6  IF(TS(JS)-TUD))4,4,3 
4  U(JU)=U(JU)+US(JS) 

3  CONTINUE 
I  CONTINUE 
1  CONTINUE 

RETURN 

END 
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SUP  ROUT  !Nr     MCREFt I, P,X) 

*  *  *  *  $  $  *  $  *  *  *   **  *  *    *  *  *  *  *   $  *  *:    £  $  $  $   ;|-  ,;r  ,;,  £    $  y^  y.  y.   g  y.  t.t,tf.t  j,    y.  y.  y.  ,(,.    y<  J;  y.  y.   ,.  y.  y,  <     J,  v,  ^ 

SUBROUT INf     MORE F 

pup  phs" 

TO  COMPUTE   TRAJECTORIES    FOR    A    GENERAL    OCEAN   VEHICU     [I 
ANY   COMEI  NATION   3F    6    DEGREES     C^    FREEDOM   WITH    VARI  A 
COEFFICIENTS     *ND    PARAMETERS    FOR    USC    ]N    MODEL     REFERENCE 
IDENTIFICATION    f  -USING  AN    EULER    INTEGRATOR 

SUDP  3UT  i"Fc     REQUIRED 
0  V  "    ' 

DESCRIPT!    N 

SECTION    6     (C)  «M.N.  HAYES    THES  I  S,MI  T,  197  lf!    AMI      DEPARTMENT 

^  #  $  #  >\'.  A  ^  £  $  >'c  $  V,-.  £  $  if,  *  -V  #  #  )}c  :$  £  $  $  $c  >J:  :V  $  *  i|:  >;-.  $  $  >;:  $  J,t  >;<  $  $  $  j|.  $  *  .-;•  >>-  $  jj-   )fe  ft  ft  ft  t-  ft  *  ft    ' 

01  MEMS!  ON    Pll)fX(l) 

Dl  M E NS I  ON    T ( 47)  ,  U(  846) , Z( 2 8 2) , Z N (282  J 

01  ME NS I  ON    f   r  (  2D  )  ,  A  V  ( ]  2 6  ) ,  X  F  ( 3  2  6  )  ,  T  N  (  6 ) ,  NE  (  ?.  7  ) ,  L  ( 6 ) 

DIMEMS3  ON    t   r  (l?f  >,LP(12  6) 

DIMENSION    X  7(6) ♦ XN'7  (6) , X0(6 ),XDN(61 

DIMENSION    U  KIP)  tTST(180),UST(180)tUS(]  8) 

INTEGER     AV,XF 

/OV/ME*AV,XF,IN,NEtKB,L ,KF,LF  ,KP  ,LP 

/STE  °S/TS  T,UST,US 

/sintg/tz  ,ot  ,T 

/SUOUT/U 

/SZOUT/7.1  ZN 

/TES  T/Er»£,E  f' Ay 

/ 1  ^ T  GR/  vl  D  T  f  K  U » N  S  T  t  K  S  1 1  ON  E 1 1 T  H  R  E  t  KUA 


COMMON 
COMMON 

CQM  MOW 
COM  M.ON 
COM  MDN 


DO    3    KM-=1»KB 

K=L (KM) 

XZ(  K)~X  IK) 

XNZ  C<)--0. 

CONT  !r'0  E 

DO     t    J=I,NDT 

JU=J 

DO    5    J  A  -I  ♦  K  U 

UI(JA)r[j(JI|) 

JU=JU+NDT 

CnMTIMUc 

CALL    OVMQD(  ME,AVtXFtP,  IN,UI  ,NEtX,XNZ  ,XD,XONiKB,  L) 

IF(ME(L9).NE.IDNE)G0   TO    7 

DO    3    KM=1,K9 

K=L(KM) 

IF(K.LE  .ITHREJGO    TO    0 

KU!  =KUA  +K-ITHRE-1 

UK  KU!  )  =UI(  Kill  )  +  X{K  )*DT 

CONTINUE 

IF<  J. CO. NOT)  GO    T0    7 

JU=^  J<-:+  (KUA-1)*NDT 

DO    9    JA=KUA  ,KU 
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6 
10 


11 


UCJUJ=UI(J/5  ) 
JU=JU+NDT 

00    2    KM=lfKB 
KZ-  J+NDT*(K  "-1  ) 

XtK)-X(  KJ+XDtKM) *D7 

z(KZ)  =  y  (K) 

IF( ABS(  Z(KZ  )  ).GT.EMAX)G0   TH 

CONTINUE 

CONTINUE 

1=1 

GO    to    i  o 

1=0 

DO    11    K  M=l  ,  K.P 

K=l  [KM J 

X(K)=XZ (K) 

CONT  INU E 

RETURN 

END 
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Slin  ROUT  INE     STOUT <T,U,Z,ZN,  IU,N,NP) 

***********************  ^ft*******,^    ,,,.....  .  ^ 

SUB  ROUT  INC     STOUT 

PUR  POSE 

TO    GENERATE    AND   OUTPUT    PLOTS    OF    SFA    T^IAL     Nr'T  SY    AND 
NOISELESS    TRAJECTORIES   AND   P|  CTS    pf   VEHICLE    INPUTS 

SUBROUTINES    REQUIRED 

PLnT 

DESCRIPTION 

SECTION    r     (C )  fM.N. HAYES    THESI S»MIT .1971 f N AME    DEPARTMEI 


INT 

DIM 
DIM 

DIM 

31    FOR 

3?  ^OP 
31  FOR 
34-OFOR 

1  »5- 
3  5  0  F  0  R 

i  »-Z 
36  "r  P 
.  3  7  0  FO  R 

1'T 
38    FOR 
KW= 

PI    A 

NPS 

n^ 

ZPL 
1  C-v 
IF< 
NC= 
ND= 
DO 
K-L 
J  7  = 
IF( 
J=N 
DO 
JZ= 
J- J 
ZPL 
5  CON 
CAL 
WRI 


->.  j  .•    *» 

EOF* 
ENS  ! 
ENSI 
ENS  I 
MOM 
MAT< 

MAT  ( 

MAT( 

MAT( 
MATt 
AFTM 
MAI  I 


***$  ***£****  $*****$**$$£  #*$*  .  |  fc*  ****  A 


ON  T 
ON  M 
ON  I 
/OV/ 
IH 
1H 
IH 
IH 
IH  , 
,6-F 
IH  t 
J-  <  D 
IH  , 
IH  , 
=  *Y, 
IH  » 


XF 

(1), 

E(20 

r-il2 
M£,fl 
10X, 
'OX, 
IOXi 
10X, 
10X, 
WDW, 
10X, 
Y=+Y 
1  OX, 

'  ox, 

+  Mt- 
10X, 


LJ  { 1 ) 

)  ,AV 
6),  I 
V.XF 

'NO  I 
•NO  I 
1 
»  Njn  i 

•  TAN 
7-AF 

»  SHr 

i      " 

•  DRD 

»  JH5 
Zt-N 
1  ANG 


,Zi  j 

(12  6 

^(12 

,  IN, 

SELE 

SELE 

SY 

SY 

KS    1 

TW  ) 

OUD 

PFU 
USTE 
') 
LES 


),ZN 

)tXF 
6) 
NE.  K 

ss  u 

SS   P 

u 

p 

-PFS 


(1)  tZPU  3  76) 

(126  l,IN(6),NE<27),L 

R.L  »KF,I  F.KP  ,LP 
,V.OR  W«  t5X,  «L(KM)=« 
.Q.OR  R  '  ,  C.X,  »L(KM)=I 
,V.OR  W  ,  5X,  'L(KM)=« 
,Of0P  P*  , rX, •L(KM)=« 
,  2-STRO,  3-P0RTf4— FWD 


U  ) 


1 13) 

,•13) 
» 13  J 

,1°) 


i.-or 
) 

OR    1 

PS    1 


m  v  ( 

M  Ar  ( 

+  u 

MAT  ( 

CF    t  (N)      TNTn    ZPL (NMAX*NJ 
A-MP 

I K)  = 

TINU 

ME  (  r 

2 

2 

3    KM 

(KM) 

N*(K 

K.GT 


LTA    P, 2- DELTA   v    rtV;    +0°-', 

-RPSt2-R  PS/SEC  .      +RPS=+XH 
-  vr  W  D .2- YAFT ,  3-  7  !  I  fO  ,  '•■- ZAF  • 


1  -PHI  ,2-THETA  ,3-nr-I'  ) 


ltN 
T(K) 

).EQ.O)GC    TO    2 


1  =  1.  KB 
.3JGC   TO    4 


5    KN 

J,7-!   1 

( j)  = 

TIMU 

L    PL 
T  n  {  « 


=1,N 


ZUZ  ) 

0T(  NP*ZPL  »N»  NCtO  J 
W.30  )K 
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NP=NP+1 

Qp     T  n    t> 

if 

00    6    K  N  =1 1  N 
JZ  =  J  7  +  1 

J-J+l 

ZPL  UI=Z{JZ1 

6 

CONT  I-NU  E 

NP=NP+1 

CAl  L    PL  0T(NP,ZPL 

iN, 

ND,0) 

WRITE  IK  VI 1 31  )K 

3 

CONTINUE 

p 

IF{  ME<6  ).EQ  .0)GG 

NC=? 
MP-  2 

K=L (KM) 
JZ=N*(KM-1  ) 

TO 

7 

IF(K.GT  .31 GG   T? 

Q 

J=N 

DO     10   K  N=l »  N 

JZ=JZ+1 

J=J+? 

ZPL  U)  =  ZN(JZJ 

10 

CONTINUE 

np  s  n  n4 :. 

CAl   L    pL  OT(NP,ZPl 

,N, 

NC ,  0  ), 

WR1 TEIKVJt32 )K 

Gr     TO    8 

o 

J=f 

DO    11    K  N=1  ,  N 

J7^J7+1 

J- J  *■! 

ZPL  (J)--  7rJ(J  7) 

11 

CONT [NUE 
NP=MP+] 

CALL    PL  GTJ  NPtZPl 

»N, 

NOtO  ) 

WRI  TE(KWt33  )K 

p 

QnNT  INU c 

7 

IF(  IU.C  0.01  CO   T0 

I? 

IF(  NE(  3  ).ro  .one 

i  —  ^  • 

T? 

13 

•J  —  r  - 

NU=N*(  NEC61  -]  ) 

NO=NEt 1  ) 

DO    14    JT=1,  NO 

DC    15    KN=1,  N 

j=j+: 

NU=NU+! 

Z^L  I  J1  =  U(NIM 

15 

CONTINUE 

14 

CONTINUE 

N0=N0+1 

NP=NP+1 
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IP 

17 


16 


21 

20 


24 

23 


22 

26 

25 


CALL    PL0T<NP,ZPL,N,N0,0] 

HR1  TE(KW,34  ) 

IP{  ME(:'  &.EQ  .0)G0    1  r~    16 

J=N 

NU=N*(NE(?)  -1  ) 

NO=NEI2  ) 

DO    l7   JT=1,  NC 

Do    1  8    KN=1,  N 

J=J*1 

NU=NU+1 

ZPL  U)=UtNU  ) 

CONTINUE 

CONTINUE 

N0=N0+1 

NP=NP+1 

CAl  L    PL  "T(^';i,7PI   ,N,  N ■"■,0) 

WR1 TE(KW,35  ) 

!F( MEJ4  ).EQ .0)00    TO    19 

J=M 

NU=N*(N  E<8)-11 

NO=NE(  2  ) 

DC     20    J  T=1  ,  NO 

Dn    21    KN=J  ,  N 

J=J  +  1 

NU=NU+1 

ZPl   {  J)=U(NU  ) 

CONTINUE 

I TIMUE  .    ■ 

NONO+1 

NP=NP+  1 

CAl  L    nL  OT(NP,ZPL  ,V,  N3f0) 

WP.J  TE(K  W,36  ) 

rr( vr(r  j#EQ  ,0)G0    TO    2? 

J=N 

NU=N*{NE(9  )-U 

NO=NEC   ) 

DC    23    JT=1,  NC 

Or     HK  N=!  ,  N 

NU=  sHJ  +  '!. 

ZPl   (J)  =  UCNU  ) 

CONTINUE 

CONTINUE 

N0=N0+1 

NP=NP+3 

CALL    PLCT(NP,ZPI .  ,Nf  Nn-0  ) 

DPI  TE(KW,37  ) 

IF(  ME<!  9).EQ.0)G0    Tn    25 

WRITEU  .26  ) 

FORMAT! 5X,«  ANGLES    ARE    INTEGRATED   ANGULAR   VELOCITIES'! 

IF(  ME<  20).EO.O)GO    TO    3  2 

>N 

NU=N*(NEtlO  )-l) 
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N0=NE(5 ) 

DO    2  8    JT=1 , NO 

Dr    2  9    K  N=l  ,  N 

J=J+3 

NU=NIH  1 

IP\   ( J)=U(NU  ) 
29     CONTINUE 
2?    CONTINUE 

NO=NQ4-! 

NP^NP+1 

CALL    PLCTCNPtZPL  ,NfNO,0  ) 

12    NP=NPSA 
RETURN 


Additional   Subroutines 


OVMOD  -  Appendix  A6 
PLOT  -  Appendix  A5 
XDIST  -  Appendix  A? 
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APPENDIX  A18 

SUBROUTINES  USED  IK  6*6   EXTENDED  KALHAN  FILTERING 

SU3R  OUT  IN  E    EH DOT ( X , U , P ,E,XO,bU) 
C    ****'**£*.  ********  ^v>; 

C    SUBROUTINE    EI-DOT 
C 

C    PLRPJSE 

C    TO  COMPUTE  THE  DERIVATIVE  OF  THE  ERRCR  COVARIANCE  MATRIX 
C    FOR  A  GENERAL  OCEAN  VEHICLE  KALMAN  FILTER 
C      SOLVES  THE  EQUATIONS 
C        EHDOT  -  ED=F-^E+E::FTRANS  +  Q 
C        F        OVDER 
C        XD       OVMCD 
C 

C  SUBROUTINES  REQUIRED 
C    3VMOD,CVD£R 
C 

C  DESCRIPTION 

C    SECTION  6  (OtMoNoHAYES  ThESl S , MI T7 1971 , NAME  DEPARTMENT 
C 
C  £*  *  -:  ■■  -'.'  •• "  *  ' 

DIMENSION  X<l),U{l),P(i),E(l),XD(l),ED(l) 

DIMENSICN  ME (20  J ,  AV  ( 126  ) ,  XF  ( j.26  ) ,  IN  (6  )  ,NE  (  27 )  ,L  (  6  ) 

CIMENSICN  LF{ 126) ,LP(126) 

DIMENSION  Q(6)  ,XN(6),XND(6) 

DIMENSICN  FQ200)  ,  R(6  )  ,  I  NV  (  6  )  ,  RV  1 12  ) 

INTEGER  AV,XF 

COMMON  /CV/ME,  AV,XF,  If\,NE,KC,L,KFtLF,  KPf  LP 

COMMON  /SNOIS/Q»RfINV#RV 
C      CALCULATE  XO  AND  F 

CALL  C  VMCD ( ME , AV , X  F , P ,  I N , U , NE , X , XN , XD , XN D , K 8 , L ) 

CALL  CVOER ( ME t U f AV f XF f KFf LF fKB, L i X fKP fLPf P»Ff NF tNEI 
C      CALCULATE  THE  1-ST  KB*KB  TERMS  OF  ED 

NV*1 

N  =  l 

DO  1  J=1,KB 

DO  2  1=1, KB 

EC(NV)=Oo 

DO  3  K=1,NF 

MF=I+KB*(K-ll 

MFT=K*NF*(J-1  ) 

E0(NV»=ED(NV)4FCMF)*E(MFT  l+ECMFM  F  (MFT) 

3  CONTINUE 

IF(  UNEoJ)GJ  TO  A 
ED(NV)--EC(NV)+Q(N) 
N=N  +  1 

4  NV=NV+1 

2  CONTINUE 
1  CONTINUE 
C      CALCULATE  THE  REMAINING  KB*(NF-KB)  TERMS  OF  ED 

NR=NF-KB 
DO  5  J=1,NR 
DO  6  1=1, KB 
ED(NV)=0. 

DO  7  K=1,NF 
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MF  = 

MFT 

ED( 

7 

CCN 

NV= 

5 

CON 

5 

CON 

RET 

END 

I+KB»{K-1 ) 
*K+NF*IJ~1I 

NV  i  =  EO { NV ) *F (  MF  )  *E  ( MFT } *  E  (  MF  >*F  CMFT  I 

TINUE 
NV  +  1 
TINUE 
TINUE 

URN 
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SUBROUTINE  KGAINC E , K3, NF, EG ) 

C  SUBROUTINE  KGAIM 
C 

C  PURPOSE 

C    TO  COMPUTE  THE  GAIN  MATRIX  FOR  A  KALMAN  FILTER 

C      SOLVES  THE  EQUATION 

C        GAIN   -  EG  =  E*(E  +  R)ir\V 

C 

C  SUBROUTINES  REQUIRED 

C    MINV  (IBfVSSP) 

C 

C  DESCRIPTION 

C    SECTION  6  (C) , Mo  No  HAYES  THESISf MIT, 1971 , NAME  DEPARTMENT 

C 

C  *  •  J  '  ;..■:.: 

DIMEKSICN  E(i ) ,EG(1) 
DIMENSION  R{6),EI(36),LV{6),MV{6) 
DIMENSION  Q(6),INV(6),RV(12) 
COMMON  /SNOIS/Q,R,INV,RV 
C      FORM  MATRIX  INVERSE  OF  (HEHT+R) 
NV=1 
N»l 

DO  1  J=1,KB 
DO  4  1=1, KB 
EI(NV)=E«NVJ 
IF( IoEQoJ)GO  TO  5 
GO  TO  6 

5  EI(NV)=EI(NV)+R(N) 
N  =  N+1 

6  NV=NV+1 

4  CONTINUE 

1  CONTINUE 

CALL  MINVCEI ,KB,D,LV,MV) 
IFIDjEQ-.Ot,  )GO  TO  8 
C      FORM  GAIN  MATRIX  EHT  {  HEHT-J  R  )  INV 
NV=1 

DO  2  J=1,KB 
DO  3  1=1, NF 
EG<NV>=0„ 
DO  7  K=1,KB 
IK=IvNF-(K-l ) 
I E=K+KB. ( J-l ) 
EG(NV)=EG(NV)+E( IK)*EI(  IE ) 

7  CONTINUE 
NV=NV+1 

3  CONTINUE 

2  CONTINUE 
RETURN 

8  WRITE(6,9J 

90FORMATUX, 'SINGULAR    MATRIX    IN    KGAIN,     «, 
l'SETTING    EI=lo/DIAG(EI)    ') 
EPS^lo  CE-40 
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IKB=KB*KB 

.00  3.0  K  =  l  ,  1KB 
EKKI-O, 

10  CONTINUE 

DO    11    «=1,KB 
IK  =  K  +  KBJ-  (K-l  ) 
EIV=E( IK)+R(K) 
IF(CIVoEQoCc  >EIV^EPS 
EI(K)=lo/EIV 

11  CCNTINUE 
RETURN 
END 


-518- 


SUBROUTINE  UP CAT ( Z , X, E, EG ,XH, EH, KB ,NF ) 

SUBROUTINE  UPCAT 

PIRPGSE 

TO  COMPUTE  THE  UPDATED  STATE  VECTOR  AND  ERRCR 
COVARIANCE  MATRIX  FOR  A  KALMAN  FILTER 
SOLVES  THE  EQUATIONS 

STATE  -  XH(UPDATED)=XH+E&v(2-XH) 
COVo   -  EH{UPDATtC)=EH-EG:EH 

SUBROUTINES  REQUIRED 
NCNE 

DESCRIPTION 

SECTION    6    (C)fMoNoHAYES    ThESi  S,. -II  T  ,  1971  , NAME    DEPARTMENT 

D I M ENS  ION    Z  (  1  )  ,  X (  1  )  ,  E  (  1  J  ,  EG  ( 1  )  ,  XH  (  1 ) ,  EH  (  1 ) 

DIMENSION    XZ(6) 

FCRM    Z-H"X 

DO    1    K=1,KB 

XZ(K)=Z(K)-X(K) 

1  CONTINUE 

UPCATE    THE    NF    STATES,     XH 

DO    3    1=1, NF 

XHU)=Co 

DO    2    J=1,KB  .    . 

KF-I+NF    (J-l) 

XH(  I  )  =  XH(I  )  +  EG(KF)-   XZ(  J) 

2  CONTINUE 

3  CCNTINUE 

UPDATE    THE     (  N  F*.  {  NF  +  1 )  )  /2    ERROR    COVARIANCES,     EH 
NV  =  1 

DO    4    J=1,NF 
DO    5    1=1, J 
IF(  IcGToKBJGO    TO    7 
KI=I+KB- ( J-l ) 
EH(NV)=E!KI ) 
GO    TO    8 
7    EH(NV)=0J 

3  DJ    6    K=1,K6 
KE=I+NF> (K-i) 
KI-K+KB*( J-l) 
EH(NV)=EH(NV)-EG(KE) :E(KI  ) 

6    CONTINUE 

NV=NV+1 
5    CGNTINUE 

4  CONTINUE 
RETURN 
END 


-519- 


APPENDIX  A19 
MAIN  6*6   IDENTIFICATION   PROGRAM  STATEMENTS   IN  FORTR_AN_JV_(mAINJ>_ 

Cf  -if   jfe  -Jjr    -''   ■&   ■£*  -**    4jt  X  aj#  *  jfe  *   »';   ,'-  ■**   J*   ;'-   -J'     '-   ;'-    ;';  5'-   V-    A    •'-  *    -'-    »'»   *    J,  J.    ,»-  J,  ,',    J-   V'  *   4t   *fe  *  JM  -'•    A  -»-  A   -"-  X   J'   ->-    J-   -•'    J-  J-    ■*-   J-   J* 

C    MAIM 

C 

C    MODEL    REFERENCE    AND    <Al  UN    FILTER    PROGRAM    FOR    THE    3SRV 

C 

C    PUR°GSE 

C         TO    STUDY     IOENTIFIABILITY    OF    THE    SECOND    DEGREE    AND    EFFFCTCP 

C         COEFFICIENTS    DF    THE    DSRV    FROM    INTERNALLY    GENERATED    FULL 

C         SCALE    SEA    TRIAL    DMA 

C 

C    LANGUAGE    :     FORTRAN    IV 

C 

C    SUBROUTINES    REQUIRED 

C         SEATR, STOUT,  ,CONTUR,PLOT 

C 

C    COMPILED    COP-     R!-^:li     '    IE  STS 

C         IBM    360/65    250K     BYTES 

C 

C    AUTHOR 

C         MICHAEL    N.    HAYES     , 3M. 5-333, MI T, EXT.     6307 

C 

Cj-  O.  X-  *■,  .o  -J.   .»-  k    j-  ju  -»  -J,   X  -'-  »•-  X  -•-  --  X  -».  .«-  X  -t-  -•-  X  A.  X  X  X  J-  X  -•-  X  -'-  -  -  »•-  -•-  .'-  -•-  -•-  X  .',  **,  -'*  -•»  -J-  -»-  -•  -•-  -■  J 
V'f  V  '(-  '-  "IP  IT*  *<-  "T  *V*  -V  T  "IT  T  ">"  *'*  IT  *'*  *'*  TT  -■*  -**  *fk  1*  ".*  •*"  1-  V  't*  -,-  't»  -.-  -.-  -.^  *  •  -,  -i*-  -t  -,*  -,'  -i-  -|-  V  'f    •>-  "i-   IT  "*••  1*  T  V 

C 

C    DECLARATION    STATEMENTS 

DI ME NSION    ME ( 29 ) , AV( 1 26 ) , XF ( 1 26  j , I N ( 6) , NE (27) , L ( 6 ) , M{ 6) 

DIMENSION    LF( 126) , LP (126) ,Q(6) ,PG(8) ,U(18),R(6) fP(537) 

DIMENSION    PS  (587)*  X(  258  ),,  XS(  2  58  )  ,XN(  258),XH(25S)  ,  PH(587) 

DIMENSION    EH(201G0),E( 120  ) ) , F( 1200) , IOUT( 1C ) 

DIMENSION    I  31  (5)  ,  IBLT(  ID)  ,JBLT(10)  ,ABLT(10;) 

DIMENSION    rST(180) ,UST( 18(  ),QN(6) ,RN(6) ,US(18) 

DIMENSION    IXWR(6) , JXWR (6) , IXW(8) ,JXW( 8) ,KXW(8) 

DIMENSION    LXW(8)  ,LFW(  L26) 

DIMENSION    MSPU4)  ,NGP(  14)  ,LFP(537) 

D I  ME  NS I  ON    CO (47 ) , CN( 5 1 ) , COSTt  2397) 

D I  MENS  I  ON    I  MR F ( 4 ) , I NV ( 6 ) , RV ( 12 ) , I MRT ( 4  J 

DIMENSION    XINC(258)  , PINC(587) 

D I  ME NSI ON    T( 47 )  ,  JO( 846 )  , Z ( 282 ) , ZN( 2 d 2 ) 

DIMENSION    XSTR ( 258)  , PSTP (587  ) 

INTEGER    /W,XF 

INTEGER    I BL/ " Bf  f • L • t ■ 0" f "C ' f ■ K • / 

I\'TEGF3     IXWP  /  'X'  ,  *  Y'  ,  '  Z  !  t  '  K1  ,':"»'  'V  f 

I NTEGEP    JXWR/  •  U ■  f  •  V •  t '  W  S'PS'Q'f'R'/ 

I NTEGER     IMRF/ • P "  ,  » A '  ,  ' S  '  ,  ' S ' / 

COMMON    /OV/ME,AV,XF»IN,NE,KB,L,KFfLFfKP,LP 

COMMON    /SMOI S/Q.P  ,INV,RV 

COMMON    /ST^DS/TST,UST,U 

COMMON    /SINTG/TZ,DT,T 

COMMON    /SUOUT/UD 

COMMON    /SZOUT/Z,ZN 

COMMON    /TEST/EPS, EMAX 

COMMON    /INTGR/NDT,KUfNST ,KS ,IONE , ITHREfKUA 

KR=5 

KW=6 
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J.    J,    J-   ,'-  -V  J.  *JU  -J-  ~U  JU  J,   -J,  J-  ^> 
^-  -i-  -•*  V  m-  *•*  1*  'C   -T  -T  -,-  *»*  -i»  '.• 


204 


121 
1?? 


I N I  T  T  A  L. 
DREAD 
1NHMA 
P.  E  A  D 
READ 
FORM 
READ 
READ 
FORM 
F  0  R  I 
RE  A!> 
READ 
DO  5 
[N(J 
INVl 
CONT 
FORM 

F  D  r>  -1 
FORT 
READ 
READ 
REAO 
00  4 
HV=M 
REAO 
MP=M 
CONT 
READ 
READ 
READ 
READ 
READ 
READ 
READ 
REAO 


PROGR 
(KR,  1 
X  ,  N I  N 
(KR,  1 
[KRf2 
AT(4I 
(KR,  1 
(KR  ,  1 
AT  (I  A 
AT  (14 
(KR,2 
(KR,  1 

J=l, 
)  =  J  :  1 
J)  =  J* 
INUE 
AT(2r 
AT  {  40 
AT  (1C 
(KR,2 
<KR,2 
(KR,  2 

1  =  1, 
E  (  I  +  K 
(  K  5  ,  ?, 
EU+K 
IMUE 
(KR,3 
(KR,3 
(KR,3 
(  K  R ,  3 
(K'J,  3 
(KR,3 
(KR,3 
( K  R ,  3 


X 

rs 
) 

34 
5, 
21 

2  2 
,  1 
14 

)  ( 
)  ( 
KS 
1  I 

1 


DAT 
S  ,  K  M 
N I  N , 

)  I  SI 
2E10 
)NGP 
)  (NG 
4 1 4  J 
) 

M  (  J  ) 
■'  E  (  J 

1 
)i 


-  J.   ml*  -•-   .•-   o*    .',     'j   JU    „',  »»,  V-   **-   JV  *'-    **-  V       "'     '■   JU     i-     *-   JU   -■'    -*»  JU    J*  -A-     L  JU  X  .U  j,    j_   J,   J.   j-   Ju   _»-   J„ 

-  -,.  -,-  -.-  -.    -,-  -r  -v  -,*  3^  -/.  >^  *y.  ,,-  ;,    -,*  -  - ,  3gt  if  .,c  ^,  y^  .y  gp  ?*  *,%  £  qi  9  £  £-  .-^t  sp  7* 

A     INPUT 

E , K AV , KNE  , MP , K MV , KM P , KPF , KX , KPG, KU  , 

NST,NOUTtN8t T ,KNP,NMR1 

KF I L , I D NE , NCN , NCD , NMR , I ABO , I THRE , KUA 

XT, ISFVf ,KEH,KEF,EPS,EMAX 

.2) 

I, (MGP(J) ,J=1,NGP1 ) 

P{ Jj,j=l ,NGPI) 


,  J  =  1 ,  K  S ) 

)  , J= 1 , K M I  ) 


2) 
tV(J)  ,J  =  1  ,KAV) 

F ( J) , J=l ,KAV) 
!E(  J)  ,J=1,KNE) 


14} 
12) 

i:  a . 

)  (  Ai 
)  (XI 

)  IN 

<  IP 
■\  V  )  -  1 

)  (  p  s  (  j  ) ,  j  =  •;  p  ,  a  v ) 

MV) 

) (PS(J) , J  =  MP,KNP! 

HXS(J),J=1,KX) 

)(PG(J),J=1,KPG) 

)  {  J  S  (  J  )  ,  J  =  1  ,  K U ) 
)  (XINC( J  J  ,J  =  1,KX)    • 
) (PINC(J) , J=l ,KNP) 
9) ( J,XH(J) ,JJ=1 ,KX) 
9)(JVPH(  J)  ,  JJ=1,K<N   ') 

ju  ju  4?   Jf   -»-  »*-  -.«-  *•-   J-  ^.u-  *u  »«* 

'•      '.-   '.-    IT      P   I"  '■*   *•"     *V*  TT*    TT  "V 

INITIAL     STRUCTURE    SELECTOR    SETUP 

DO    ?  J=l ,KS 

L(J)=0 
20C    CONTINUE 

K8  =  r:> 

DO    5    1=1, KS 

K3=KB  +  M(  I  ) 

IF(M(I).EQ.1)L(KB)=I 

5    CONTINUE 


;.  ',*  ->  ',-  -,*  : 


ot,  J,  ju  •*-  ■ 


JU  -'-   J-  J-   J-   ■*•■   **-  -w*-  ■»»'  .'-  -'-  •'-  -'-  •'*  J-  ->-  -**■  -J'    •*-  >*-  •*■  »'-  ■»'-  -'-  V*  »''  -■'  -'■ 
'i-  T  T"  "•-  -*-  -.-  -r  "r  -t-  ->-  -»-  *  -i-  I"  '•'  ***  't*  '.*  f  V   TT  ^"  '«v  ^*  -t-  *.-  T-  *r 


L  J*  J.    J.    -r,  ... 


■  O*.  »•»  »«-  ^'-  .'- 


SET    ALL    QUANTITIES    TO     INITIAL    VALUFS    OR    TO    ZERO 
DO    7    J=1,KX 
X  (  J  )  =  X  S  (  J  ) 
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181 


13? 


is: 


1  ••' . 


201 


202 


203 


13 


1^ 


60 


XN( J)=XS( J) 

XSTR{ J)=XH(JJ 

CONTINUE 

do  181  j=i 

,  2  8  2 

1 1 J )  =  0  . 

ZN(  J)=."  . 

CONTINUE 

DO  182  J=l 

t2397 

COST(  J)  =■;. 

CONTINUE 

00  183  J=l 

,846 

UO(J )=' . 

CONTINUE 

00  184  J=l 

,NOUT 

[OUT! J)=0 

CONTINUE 

00  20  1  J=l 

,NIND 

I BLT(J)=n 

JBLT [J)=0 

ABLTCJ)=0. 

TINUE 

00  202  J=l 

,51 

CN( J)=0. 

CONTINUE 

DO  203  J=l 

,47 

COCJ)=0. 

T(J)=0. 

CONTINUE 

00  -\    J=l  ,K 

s 

P( J)=PS< J ) 

PSTR  (  J)=Pr! 

(J) 

CONTINUE 

KF=0 

KP=0 

DO  9  J=l ,KAV 

LF( J)=A 

LP( J  >=C 

CONTINUE 

On  13  J=l, 

K  EH 

fh(  J)-- :. 

CONTINUE 

DO  14     J=l, 

KEF 

E  {  J  J  =  0 . 

F( J)=0. 

CONTINUE 

DO  60  J=li 

KS 

Q(J)=0. 

R(J)=0. 

QN(J)=0- 

RN<J)=0. 

CONTINUE 

DO  61  J=l, 

NST 

TST(J)=-1. 

0 
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61 


c 

C  WRIT 


UST( J>=0« 

CONTINUE 

DO  80  J=1,KU 

UU)=US(J) 

CONTINUE 


,  0.  >r  ,,.  *,.  ,, 


ft  FOR  REFERENCE 


253 
254 

2  5  5  i 
1 
2 

j 

1 

2690 

1 

2 

2560 

1 

2570 

1 

258 
259 
260 

261 

26? 
2  63 
2  64 


F  INITIAL  DftT 
WRITE (KW, 91 ) 
WRITE (KW,2  53 ) 
FORMAT!  LH  ,  1  X  ,  1  1  9  (  •  *  »  )  ) 
WRI TE(KW,254) 
i  ORMAT ( 1H  , 54 
WRITE (KW,92 ) 
WRITE(KW,2  55 ) 
MAT  (  lri  ,  IX 

:  -  t 


-V  ;V    3'-    ^  »•-    J.    J      -'-   J,   V-      '-    ft     J-   >*'    JL   V,   ,1,    J,    .'.    J.-   ,<,   -•.    .»-    .1.  J-    *.    J.    „»,   J.    J.    j.    -»- 

-»-  «v  V  A *  -,    -i-  >r  V  '.•  v  ¥■  V    i-  'r  T  'j-  ¥  ¥    ■•  -■    'i-  -<•  V  -.*  -r  T  '•    ''"    '    T 


X, «  INI1  I AL     DATA*  ,  V>X) 


'       KNE'SHi 
•        KPF=,,I/t»' 
rfRITE(KW,269) 
IABO,KEF 
FORMAT (1H    ,  IX 
«     N  I  -N  D  ^-  *  t  I  6  ,  * 


KS,KMI  ,  KA 
, '        KS     =» 
MP    = » ,  1 
KX    =«,I 
N I N  ,  N  S  T  f  K 


V,KNE,MP,K  IP,KPF,KX,KPG,KU 


,  '     N 

NDU 

=  »  ,  14, '     IAB 

NHM4 

•     N 

•  , 1 4 ) 

^JRFF 
,' 

'  N 
(J,1' 
,«MG 
(  J,N 
i  •  NG 
(J ,  M 

,  '  :' '  ( 
(   J   7  M 

(  J  ,  M 
,  »ME 
(J,  I 
,  •  IN 
(J,  I 
,  •  IN 
(  J ,  N 
,  » NE 
(  J,N 


265 


WRITE(KW,2  56) 
FORMAT {1H    ilX 

14, •  ITHPE  =  ' 
■•'  R  I  T  f  (  < !-, ,  2  57  J 
'AT (1H  ,  IX 
'  NCN  =*, 15, 
WRI  TE(KW,258) 
FORMATtlH  tlX 
WRI1 l (  CW,259) 
FORMAT {1H  ,  IX 
WRITE (KW, 26C  ) 
FORMATtlH  , IX 
WRITE(KW,261 ) 
WRITE (KW, 261) 
FORMAT (1H  , IX 
WRITE (KW,262) 
FORMAT (1H  ,1X 
W R I  TE  (  K W ,  2 6  3  ) 
F  ORMAT ( 1H  , 1 X 
WRITE (KW,264 ) 
FORMAT! 1H  ,1X 
WRITEUW,  264) 
J  0=1 
JT=14 

DO    265     1=1 ,8 
WRITE (KW»266J 
JO=JT+l 
JT=JT+14 
CONTINUE 
WRITE(KW,266) 


IN  =' 
T  =  '  ,  I 
0=»,I 
X,  I  SI 
HMAX 

,KFIL 

M  i}  p  p  - 

M  R  =  ' 
Gr->(  J) 
P  (  J )  = 
GPU) 
r>  (  J  )  - 
(  J  )  ,  J 
J)  -■ 
E  (  J )  , 
E  ( J  )  , 
(  J)-« 
N  <  J  )  , 
(  J  )  -  • 
NV(  J) 
V  {  J  )  ! 
E  (  J  )  , 
(  J)-« 
E(  J)  , 


4, '       KPG  =  '  ,14,  ■       KU    =f , 14 ) 
NPfNIND,NOUT,NBLT,NMRT, IOMF , 

,  14,  '     NST    =  ■  ,14,'     KNJP    =*,I4, 

4, '    NBl  r=* ,14, '    NMRT=« ,14, 

4, '     KEF     =' , 14) 

XT, ISEVT,ITHRE 

=  ' ,  14,  »     I S I  XT    =  ',  14,  •     ISeVT     =»  , 

,NCD,NCN,NMR,KEH,  ■■!;■  '\ 

1  ,  15,'       KFIL=' ,15, '       NCD    =•  ,  15, 

, 15, •       KEH    =•,  15, *       NGPI='  ,15) 

,J=1,NGPI ) 

I,4X,14(1X,I2,*=,,I3)J 

,  J  =  l  ,Nr,»T  ) 

1 ,4X,14(1X,I2,,=I , 13) ) 

=1,KS) 

,6(2X,I2,,=»,I2)) 

J=l,l    i) 

J=l 1 ,KME) 

,10(2X,I2,»  =  %I4)) 

J=l ,KS) 

, 6(2X,I2,,=',I7)) 

,J=1,KS) 

,6(2X,I2,»=f ,17) ) 

J  =  1 ,  1 4 ) 

,  1 .4  (  2  X  ,  I  2  ,  ■  =  '  ,  I  2  )  ) 

J=15,KNE1 


( J, AV( J) , J=JO, JT) 


( J,AV( J) ,J=JO,KAV) 
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2o6 


267 
263 


27  "• 
271 


272 
273 

274 


275 
277 
278 


FUR 
J0= 
JT= 
DO 

■  :<] 

JO= 
JT- 

CO'^i 
W  R  I 

W  R  I 

JO= 

JT= 

DO 

WRI 

JO- 

JT  = 

COM 

WRI 

F  0  R 

W  R I 

WRI 

W  R I 

WRI 

JO= 

JT= 

WR] 

J      : 

JT= 

C  0  M 
WRI 
F  .  ' 
I  S  v 
JO= 
JT= 
I 
W  R  I 
WRI 

DO 

WRI 

JO= 

JT= 

CON 

GO 

I  S  H 

GO 

WRI 

W  R I 


M  AT (  IN    f IX , • AV ( J )- » f 14 ( 2X , 1 3 , » = • , I  2 ) ) 

1 


14 
26  7 
TE( 
JT  + 
JT  + 
T  I N 
TE( 
1 
TEl 
TE( 
TE( 

TE( 

i 

X 

27 : 

TE( 

JT  + 

JT  + 

'  I 

TEl 

MAT 

TE( 

TE( 

TEl 

TE( 

1 

5 

272 

TEl 

JT  + 

j  r+ 
T  IN 

TEl 

f>  AT 

=  1 

1 

5 

TEl 

TEl 

TEl 

TEl 

275 

TEl 

JT  + 

JT  + 

TIN 

TO 

=  2 

TO 

TEl 

TEl 


1  = 
K)  , 
1 
14 

UE 
KWi 

(  111 
i 
K!  i 
KW, 
K  ', 


1  = 
KW  , 

1 
5 
UE 

K  W  i 
(  1H 
KW, 
I  . 
KW, 
KW, 


1,8 

2  68) 1J,XF1 J) ,J=JO, JT) 


266) ( J , Xf: ( J ) ,J=J0,KAV1 

,lX,'XFlJ)-»f14(2X,I3,,=,,I2)) 
91) 

2  53) 
254  ) 

92) 


1,51 

271 ) 1J,XS1J),J=J0,JT) 


271) (J,XS(J) ,J=JO,KX) 

,  1  X  ,  '  X  S  1  J  )     -  ■  ,  5  (  3 y  ,  I  3  ,  '  =  •  ,  F  1  3  .  <\ )  ) 

91  ) 

2  53) 
2  54) 

92  ) 


1=1,51 

;     , 2  73)1 J,XINC1J) ,J=JO, JT) 
] 

5 

UE 

KV  ,2  73 ) ( J, XINC1 J)  ,J  =  JC ,KX ) 

1 1H    , 1 X , " X INC  1 J  ) «  , 5 (  3X,  1 3 , «  =  • , F 13 . 4 ) ) 


1  ) 
KW,2  53  ) 
KW,254) 
Kir  ,9  2) 

1=1,51 
K/,  ,276)  (  J  ,  PS1  J  )  ,J=JO,JT  ) 
1 

UE 

1277,273) , I SW 


274 

K  W ,  9 1  ) 
KW, 2  53) 
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2  79 
276 

280 


281 

2  83 
2  34 


285 
232 

2  8  6 


267 


288 


WRITE 
14RITE 

00  27 
WRIT  E 
JO=JT 
J  T = J  T 
CONTI 
W  R I  T  E 
FOI 

1  SW=1 
J  0=1 
JT  =  5 

W  RITE 

TIE 

1  TE 

H  R I  T  E 

DO    28 

WRITE 

JQ=JT 

J  T  =  J  T 

CONTI 

GO    TO 

I  SW=2 

GO    TO 

ITS 

WRITE 

1TE 

WRI  TE 

DO 

W  RITE 

JO-JT 

JT  =  JT 

Cl    .1  I 

WRITE 

FOR^A 

W  RITE 

WRITE 

ITE 

FORMA 

I  TE 

WRITE 

TIL 

ITE 

FORMA 

WRITE 

wri  re 

FOf 

.-  R  I  T  E 
WRITE 
WRITE 


(KW, 

(KW, 
9     1  = 
(  KW  , 
+  1 
+  5 
NUE 
(KW, 
T(  1H 


t 


(KW, 
(KW, 

■ 

(KW, 
1  1  = 
(KW, 

+  1 
+  5 

.-■JUL 
(23 

28  C 
( K  W , 
I 

(KW, 
(KW, 
5  1  = 
(K 

H   1 

+  5 
NUE 
( K  W , 
T  (  1 H 
(K!   , 
(KV  , 
I  K1   , 
1  (  II I 
: 
(I     , 

(KW, 

( K  W , 
T  ( 1 H 

(KW, 
[KV  , 

T  ( 1  H 

(KW, 
(KW  , 
(KW, 


2  5  4) 

92) 

1 1 1 5 

2  76) (J,PS( J),J=J0,JT1 


2  76) { J,PS( J) ,J  =  JO,  KfSiP) 
, IX, • PS ( J)     -• ,5(3X, 13, •=«, F13.4)) 


91) 
2  53) 
2  54) 

92) 

1 1 5 1 

2  82) ( J, RING (J) ,J=JO, JT) 


3,284) , ISW 


91  ) 

2  53) 

2  5-4  ) 

92) 

1,15 

2  32 ) (J,PINC(J) ,J=JO, JT) 


232  ) 

tlX 

92) 

) 
->  g , .  ) 

flX 
9  2) 
287) 
2  87) 
287) 

rlX 
92) 
2  8  3) 

flX 
2  53) 
253) 
92) 


{ J, PINC (J) ,J=JO,KNP) 

,  •  ? I NC ( J ) •  , 5  (  3X,  13 , '  =  ■ , F 13.4)  ) 

(J, PG( J)  ,J  =  1,5) 
(J,PG( J)  ,J  =  6,KPG  ) 

,  '  PC(  J)     -'  ,5  (3X,  13  ,  •  =  '  ,  El  3.  -*)  ) 

(J,US(J),J=1,6) 

(  J,US(  J)  ,  J  =  7,  1.2) 

(  J,US( J) , J=1 3,KU) 

, ' US( J )  '  ,6(2X,  13  ,  »  =  '  , F13.4)  ) 


,5C X  ,  '  END    OF     INITI M    DATA*  ) 


»i.  .■,  >>.    ^^g.  ,<. 
■*•  -i*  -r  v  t  -.*  i» 


■j.   -a.  .•-  „'.   o-  •»•»  *'^  -. 


'i"  nr  "r  '•-  '•"  '•'  "**  '■'  t" 


L     * 

C  READ  THE  NUMBER  OF  BLOCKS  AND  TEST  FOR  A  BLOCK  C 
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15 


16 


2 


2 


F 

R 
F 
D 
I 
C 

w 

89CF 

1  ( 

W 

•-.■ 

90  F 

I 

T 
i 

I 

G 


17 
19 


EAD 
EAO 
ORM 
0  1 
F<  I 
ONT 
RIT 
ORM 
SED 
PIT 
RIT 
ORM 
RIT 
R]  T 
CD= 
CN= 

a  t 

Rl  1 
ORM 
TOP 


(K 

(K 
AT 
6 

BL 
IN 
fc< 
AT 
I 
E( 
E< 
AT 
E( 
E  ( 
IC 
NC 
G 
E( 
AT 


R,  1)NB 

R,15)  (  Ira.  "I  (J)  ,J  =  1,NBLTJ 

(5A1) 

J=1,NBLT 

(J) . NE. IBL1 (J ) )GG    TH    17 

Uf 

KW,289 )NB 

(1H     ,]>:,'  THERE    ARE     •  ,  13 

N    TH IS    RUN  .  '  )    • 

>2) 
KW.2  9  .  ) 
(Hi     ,  IX, 
K     , '  2) 
KW,2  53) 
D-l 
N-l 
IS 

KW,  19)  UBLT(  J 
(IX,  5A1  ,5X, '  I 


Bl 


1     '.'-S1, 


1    ll    i  IN    FIRS!    BLOCK'  ) 


)  ,J 

\NT 


=  1  ,  N 
IAL 


BLT  ) 

P'<(  Gl 


iATA    ERROR    M 


C 

c   * 
C    B 

c 
c 


-',  .1^    -!.     .•*    U-  ■ 


.,-  — p  *r  ,  .  -,, 


-;•::':  *  •' 


EGIN  BLOCK  CALCULATIONS 
18  DO  10  IB=1,NB 


22 
21 


24 
23 


26 
25 


28 
27 


30 
29 


32 


READ  B 
[EAD 
1  IXH, 
IF(  I 
DO  2 
(  J) 
GO  I 
IF(  I 
DO  2 
M  E  (  J 
CO  IT 
[Ft  I 
00  2 
LFCJ 
CONT 
IF(  I 
00  2 
LP  I  J 
CONT 
IFCI 
DO  .3 
X(  J) 
XN<  J 
CI  1 1 [ 
IF(  I 
00  3 
P(  J) 
CONT 


LOCK  DATA  AND  IN  IT 
(KR, 1 JN3L0K iNPB, I  : 
IPH, IE , [NO i INR, 10 
.NE .0 )G0  TO  21 

2  J=1,KS 

_  r 

INUE 

1E.NE.  I G   TO  23 
4  J-1,KMV 
)  =0 
[NUE 

LF.NE.O)-GO    TO    25 
6    J=1,KAV 
)  =  0 
INUE 
LP.NI .     >GG    TO    27 

3  J=1,KAV 
)=0 

INUE 

X.NE.OGO    TO    29 

0    J=1»KX 

=XS(JJ 

)=XS(J) 

INUE 

P.NE.OJGO    TO    31 

2    J=1,KNP 

=PS( J) 

INUE  -526- 


I  '\  L  I 

,  I  M  E 


ZE    SELECT 
,  I L  F ,  1 1 


EC    V 
IX,  I 


\      l  A  3  L  t_  S 

3 , 1 0  , 1 K  ,  I U , I  ST , 


31 


34 
33 


36 
35 


38 
37 


82 
81 


63 
62 


65 
64 


67 
66 


77 
113 


115 
11* 


116 

* 
39 
40 
76 


IF{  I 
DO  3 
EH  (J 
CO  NT 
IF{  1 
DO  3 
0<  J) 

IF(  I 
DO  3 
R(  J) 
CONT 
IF<  I 
•  I 

iJ{  J) 
CONT 
I  F  (  I 
00  6 
TST( 
UST{ 
CONT 
IF(  I 

00  6 
ON  (J 

CONT 

IF(  I 

on  6 

RN(  J 

If  (I 
DO  7 

1  HUT 

I 
IF  (I 
)0  1 
XI!  (J 
CONT 
IFl  1 
DO  1 
PH{  J 
CONT 


E.NE. 

4  J=l 
)=0. 
INUE 
Q.NE.. 

6  J  =  1 

INUE 
R.NE. 
8    J=l 

-  n 

• 

INUE 
U.NE. 

2  J  =  l 
=  U  S  (  J 
I NU  E 
ST.NE 

3  J=] 
J)=-l 
J)=... 
INUE 
NG  .  NE 

5  J=l 
>  =  0 . 
INUE 

7  J=l 

)  =0. 
[   :  J  - 

0  .NE 
7    J=l 
(J)=0 
I 
XH.NE 

15  J= 
)=XST 

1  N  J  E 

P  H  .N  E 

16  J  = 
»  =  PST 
INUE 


)G0    TO    3  3 
,  K  E  H 


0)G0    TO    3  5 
,KS 


0)GO    TO     3  7 

,  KS 


C)GO    TO    B] 
rKU 

) 

. : ) GO    TO    62 

,    'ST 

.  j 


•C )G0    TO    64 
,KS 


.  0)GC    TO    66 


•  0)G0    TO    113 
,    II  UT 


,0)G0    TO    114 

1  ,KX 

RU) 

,0)G0    TO    76 
1  tK      ' 
K  {  J  ) 


41 


EAD  IN  CHANGES  TO  SELECTED 
FORMAT (5( I  5 , Fl 1 .4)  ) 
FORMAT ( 10 ( 14, 14) ) 
READ(KR,40MIBLT(J),JBLT(  J)  tJ 
00  41  J=l , NIN ) 
KA=IBLT(J) 
IF(KA.LE.O)GO  TO  42 
M(KA)=J6LT{  J  ) 
CONTINUE 
GO  TO  76 


,BLES 


1 ,  N I N  D  J 
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4  4 

C 

C    P 
4  3 

C 

C    R 
45 


C    SET  THE  STRUCTURE  SELECTOR 
4?  KB=C 

DO  176  J=1,KS 

KB=KB+M(J) 

(F  (  M  (  J  ) .  E  Q .  1 )  L  {  K  B )  =  J 
17b  CONTINUI 
199  R  EAD { KR, 4C  )  < I  BUT { J ) , J3LT  t  J ) , J  =  1 , N I  NO  J 

DO  44  J=1,NIND 

KA=IBLT(J) 

IF(KA.LE.O )GO  TO  4  3 

ME(KA)=JBLT( J ) 

CONTINUE 

GJ  TO  199 

T  I  -It;  VA  UABLES 
READ(KR, 3) TZ.DT 
READ(KR»  L)NDT  ,KF,KP 

EAO  IN  CHANGES  TO  SELECTED  VARIABLES 
READ(KR,40){ IBLTC J), JBLTI J) ,J=1,NIND) 
DO  ^o  J=l, NIND 
KA=IBLT( J J 
(F(KA.LE.O)GO  TO  47 
LF(KA)=JBi T( J) 

46  CONTINUE 
GO    TO    45 

47  READUR,4     K  I  BLT(  J  )  ,J3LT  tJ)  ,  J  =  l  ,N  INO  ) 
00    46    J=l  , Ml      3 
KA=IBLT (J) 
IF(KA.LE.C) GO    TO    49 
LP(KA)=J<3LT(  J) 

48  CCN1 INUE 
GO  TO  47 

49  READ(KR,39)  USLTUJ  ,ABLT(  J)  iJ  =  lfNIN     ) 
00    5.     J=1,NIN 
KA=IBLT (J) 
IF(KA.LE.O)GO    TO    51 
X(KA)=ABLT(J) 
XN(KA)=A3LT(J ) 

50  CONTINUE 
i  ]    TO    49 

51  READ(KR,39)  UBLT(  J)  ,  \3LT(J>  ,J  =  lfNIN     ) 
DO    5  2    J  =  l,NIiN 
KA=IBLT(JJ 
IF(KA.LE.O)GO    TO    55 
P(KA)=ABLT(J1 

5  2    CONTINUE 

GO    TO    5] 
55    READIKR,39)( IBLT(J) fA3LT{ J),J=1,NIN     ) 

DO    5  6    J=1,NIN 

KA=IBLT( J) 

IFCKA.LE.O)GO    TO    5  7 

Q(KA)=ABLT (J ) 
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56 

CONTINUE 

GO  TO  55 

57 

RFACtKR, 

DO  5  8  J= 

KA^IBLK 

I  Ft KA.LE 

R(KA)=AB 

5  3 

CONTINUE 

GO  TO  57 

50 

READ(KR| 

DO  84  J= 

KA=I BLT ( 

IF(KA.LF 

U(KA)=AB 

34 

COM  i  NUE 

Gl  TO  5V 

83 

READtKR, 

DO  68  J= 

KA=I6LT( 

IF ( KA.LE 

TS  T  (  K  A  )  = 

6  8 

CONT INUE 

GO  TO  S3 

69 

KFAD(KR, 

DO  70  J= 

KA=IBLT( 

I  F  (  K  A  .  L  E 

U  S  T  (  K  A  )  = 

71 

CONTI 

GO  TO  69 

117 

READCKR, 

DO  118  J 

KA= IBLT< 

IF (KA.LE 

XH(KA)=r 

118 

CONTINUE 

GO  TO  11 

119 

READ(KR, 

DO  12C  J 

KA=IBLTf 

I F(KA.Lt 

PH( KA) =A 

120 

C0N7  IN Ul 

GO  TO  11 

53 

READiKR, 

DO  5  4  J= 

KA=IBLT( 

IF (KA.LE 

E  H  ( K  A  )  =  A 

54 

CONTINUE 

GO  TO  53 

71 

READUR, 

00  12     J= 

39) ( IBLT(J) ,ABLT( J) ,J=1,NIN     ) 
i,NIN 

J  ) 

,C  )G0    TO    5  9 

L  T  (  J  ) 


39 ){  IBLT(J) ,A3LT{ J) , J  =  1,NIN     ) 

1 ,  N  I  N 

J) 

.  3 ) GC    TC     8  3 

LT  <J  ) 


39 ) ( I BL1  (J)  |A8LT( J J ,J=1,NIN     I 

1 ,  N I N 

J) 

.C )G0    TO    69 

ABLT ( J) 


39) (IBLT(J)  ,A3LT( J)  ,  J  =  l fNIN     ) 
1 ,  N I N 

J) 

.1 )G0    TU    117 

ABLT (J) 


3° )  (  IFF  1  ( J )  , ABLT( J) ,J  =  1,NIN     ) 

=  1  ,  N  1 1  i 

J  ) 

.     >G0    TO    119 

B  L  T  (  J ) 

7 

39)  (IBLTU),  A3LT{  J)  ,J  =  1,N1   I     I 

=1 rNIN 

J) 

,0)GO    Tj    53 

bLT( J) 

9 

39) ( I BLT (J  )  ,ABLT( J)  ,  J=l ,NIN     ) 

1 ,  N I N 

J) 

,C)GO    TO    71 

BLT(J) 


39)  (  I  FIT  (J)  ,ABLT(J)  ,J=1.,NIN     ) 
1 ,  N I  v-i 
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7-3 

C 

C         T 

79 

83 


KA=IBLT( J) 
•IFCKA.LF  .C  IGO    TO    73 
QN(KA)=ABLT( J) 
7?    CONTINUE 
GO    TO    71 

73  RE AD ( KR, 39 ) ( I BL  T (J ) , A6LT ( J ) , J  =  l , N I N     ) 
DU    74    J=1,NIN 

KA=I BLT( J) 
IF(KA.LE.C)GO    TO    7  5 
RN(KA)=ABLT(J) 

74  CONTINUE 
GO  TO  73 

75  READ(KR,4  )  ( I 6LT ( J )  , JBLT ( J) , J  =  l , NJ   ) 
DO  78  J=1,NIND 

KA=IBLT(J) 
IF(KA.LE.O)G)   n   7^ 
I  GUI  <KA)=JBLT<  J  ) 
CONTINUE 
GO  TO  75 


EST  FOR  BLOCK  CARD  AND  CORRECT  BLOCK  DATA 

ISW=1 

I S  W I  =  1 

READtKR, 15} ( I 3LT( J) , J=l ,NBLT) 

00  8  5  J=1,N3LT 

IF(  IBL(J ).NE.I3LT( J) ) GO  TG  36 
35  CONTINUE 

GO  TG  (133,10) , J 3\ 
86  WR I TE ( KW , 8  7 ) ( I 3LT ( J )  , J= 1 , N  1LT ) ,   I 

■    '  M   ,  ■■■   -..  ,  '\   .   '  -1 .   i>>   V)  '   '..   '    •  ,  14,  ! 

1  '  ERROR* ) 

GO  TO  ( 198  ,88) , ISW1 
198  IF(MREF.EQ.1)G0  TO  139 

ISW=2 

GG  TO  S3 
139  GG  190  J=1,NMRT 

IF( IMRF(J) .NE.IBLTt J) )G0  TG  191 

190  CONTINUE 
JP=1 

GG  TO  192 

191  JP= 

192  IF< JP.G-  .  JP3 )G0  TO  1C 

193  READ (KR , 1 5 ) { I f RT { J ) , J =1 f  NMRT ) 
DO  194  J=1,NMRT 

IF(IMRFU)  .NE.IMRT(J))GO  TG  193 

194  CONTINUE 
JP=JP+1 
GO  TG  192 

C 

C    WRITE  bLCCK  DESCRIPTION 
20  FCRMATUH1  ,5X,53(  '*•  )) 
89  FORM  AT ( 1 H  , 5  X , 5  3 (  ' * • ) , / ) 
900FORMATUH  ,5X  ,  •*  ■  ,  12X  ,7H  BLOCK  ,14, 


HAS  INPUT  [  ATA' , 
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11611  CHARACTER  ISTICS,12X,  • 

91  FORMATdHD 

92  FORMAT (1H     ) 
1 5  X  f  ■  *  •  f  5 1 X 
,5X,' 
SE    SI' 


93  FORMAT (1H 
FORMAT { I H 

130HEFF  TA 
95  FORMAT ( LH 
960F0RMAT (Hi 

114H  DATA 
970F0RMAT(1H 

112H      NO. 


1  I 


1   ) 
EL 

CO 


0    V    H    P    Q    R        , 
CB    XD,1^,,:-M 

,5X  ,'*'  ,6Xt6I2i  5X  ,913,  IX,  '  -:: '  ) 

t5Xf •*,f13H    DAI  A    PASSES     ,12, 

POINTS     ,  I  4,131 1       NO.     COEFFS     iI^IX*1*') 

, 5X,«*',7H    TZERC    ,E11.4,5H       CT     , El  J 
P  V   AM     ,  14,  IX,  •*■  ) 


I     ! 


'  ,  ISii    INITI  M  12  ING-     , 

>    E    Q    R     SI    ON    PN    J    Oi 
' ,3X, «C=  INITI Al   IZE' ,  IX, 

) 


98CF  OP I  A  T  U  H     , 5 X  ,  • : 
'       135H       M    ME    Lf     LP 
99CFORMATUH     ,5X,»- 

112,313, 512,313,212, IX, « 
133    rfRITECK    , 2  .  ) 

WRI TE( KW,90 ) NBLOK 
WRI TE(KW,93) 
WRITE (KW,94) 

WRITE  (Ki.  ,,:':>)  (M(  J)  ,  J=1,KS)  ,  (ME  (K)  ,  K  =  l  ,KMV  ) 
WRITE(KW,93) 
WRITE(KW,96)NPB,NDT,KF 
WRITE (KW, 97) TZ ,OT,KP 
WRITE(KW,93) 
WRITE  (KW,9  8) 
OVJRLTE  (Kv  ,993  I  M,  [ME  ,  I  LF  ,  I  LP  ,  IXH,  [PH,  IE,  I  I'   ,  I 
1  1ST,  10, 1  :,  10, 10 

UTE(KW,93)  .    . 


) 


X 


1 0  3 


,  5X  , 

,5X, 
,  5  X , 


TO 


1C       FOi      aT  ( ]o 

1 2 1 X ,  •  * «  ) 
1  )]  i AT  (  1H 

1 2  3  X ,  •  *  •  J 
102    FORK  AT  (  1H 
FORMAT  (  V,\ 
WRITE (KW, 1 1     ) 
JT=1 

00  10 A    J=1,KAV 
LFW( J)-0 
IFUT.GT.KFJGO 

1  F (LF ( J  1  )  . GT.J )G( 
LFW( J)=l 
JT=JT+1 

TINUE 
JK=8 
JT  =  C 
JV=0 
DO  10  5 
DO  106 
DO  107 
J1=JT+1 

IF(  JT.GT.JiOGO    TO 
KXHCJT )=IXWR(K) 
IXW< JT)=JXWR( J) 


'  ,  30H    C.OEFFK  I!  NTS    TO    BE-.IQ 

•  ,2HH    PARAME1  E     ,     TO  I     I      T  I i   1  I      , 

1  ,2X,3(  IX, 3  Al,  IX,  ID  ,1X,  «  *»  ) 

•  ,2X,6UX,3A1,  IX,  ID  ,13X,«*'  ) 


11 

TO 


IDA 


1. 


K=l ,KS 
J=l ,KS 
I=J,KS 


109 


108 
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J  X W ( J T  )  = JX WR [ I ) 

NT=J+<  !-;-•(  I -)  )  )/2+21*(K-l  ) 
I  X'..(  Jl  )=LFW(NT) 

IP  (  (K.Ef/.KS)  .AND.  (  J  .  EQ.KS  )  Jul:    TO    109 
GO    TO    I     1 
] C8    JV  =  JVH  1 

[FCJV.GE.ISIXTJGO    TO    110 

WRITE (KW,1    2)  (KXi  (JW) , IXW(JW)  ,JXW(JW  )  tLXW ( JW) , J W= 1 , JK ) 

JT=C 

go   ro  i 

UC     IF(JV.GE.ISEVT)Gf)    TO    111 

WRITE (Kl    ,102) (KXW(JW) f IXW( J     )  ,JX     (JW  )  , LXIM  JW) , JW=1 , JK) 

JK=6 

JT  =  C 

TO    1 C  9 

111  r/RITE(KWfl    3){KXW( JW) ,IXW( JW)  ,JXW{ JW),LXW(JW) ,J      -1,J     ) 
GO    TO     112 

107  CONTINUE 
It 6  CONTINUE 
103    CONT  INUE 

112  r!RITE{KW,93) 
WRI TE(KW, 101 ) 
JT=1 

DO    127    J=1,KNP 
LFP( J)=( 

IF(JT.GT.KP)GO    TO    127 
IF(LP( JTJ.GT. J)G(     TO    127 
L  F  P  (  J  )  =  1 
JT  =  J1 +1 

127  CONTINUE 
JK=8 
JV=( 

JT- 

DO  123  J=1,NGPI 

JA=NGPU ) 

JM=MGP(J i-1 

DO  126  JG=1,JA 

JM=JM+1 

128  JT=JT+1 
IF{JT.GT.JK)GO  TO  129 
KXW( JT)=J 

LXWi  JT)  =  LFP(  JM') 

IF(( JK.EQ.6) .AND.CJ.EQ.NGPI >.AND.( JG.EQ.JA) )l  I  H  1. 

GO  TO  126 

129  JV=JV+1 

IFC JV.GF. I SIXT)GO  TO  13 . 

WRITE  (Ka',  124)  (KXWI  JW)  ,LXW  (  JW)  ,JW=1  ,  JK) 

JT=0 

GO  TO  123 

1 30  I F ( J V . GE . I SEVT ) GO  TO  131 

W R I T  E ( KW ,124)  ( K X  ;  ( J  A )   ,  LXW ( JW)  , JW=1 , JK ) 

JK=6 

JT=0 

-532- 


131 

126 
123 
132 

124 

125 


GO    TU 
W  R  I  1  r   ( 
GO    TO 

T  I  N 
C GMT  IN 
,:  RI  T E  ( 
WRITE( 
FORI  I 
FOR'i  AT 


SET 


1  3  6 
C 

(,       -v  ,,-  ... .,- 

C    WRIT 


JR--  I 
JV=JR+ 
DO  136 
JR=JR+ 
JV=JV+ 
RV( JK+ 
P( JV)= 
RV(JK) 
CONTIM 


3E( 


128 

KW,125)  (KXW(JW)  ,LXW( J  I)  ,  J  1=  I  ,  JK) 

132 

UE 

UE 

KW  ,  93  ) 

Kt   i  J9) 

(lfi    ,5X  ,«  •-••  ,  2X,8(  14  ,  IX,  ID, IX,  •*«  ) 

(Hi    ,  5X  , '  *  '  ,  2X  ,  6  {  14  f  IX  ,  1 1 )  ,  13X  ,  •  *  •  ) 

E    PARAMETERS    FOR    SEA    TRIAL 

I  '3  )  -  1 

KS 

JK=1,KS 
1 
1 

K  S )  =  R  C  J  K ) 
Q(  JK) 
=  P(J  J 
Gc 
=  IOUT (4) 


»■-■    *V*    ■*»-     v»*    -'- 


291 


1 


292l 

1 


2  93 


29's 


1 


296 
297 
293 
299 
3(  C 


E  BLOC 
WRI TF( 
WRITE ( 
WRITE ( 

■  . 

W  R I  T  E  ( 

WRI TE( 
FOR       i 
»  OA  | 
W  R I 

W  R I T  E  ( 
FORI  .i 
WRITER 
WRITI  I 
FOR  '1 
•  BLOC 
DO 

I  f  (  (  J 
GO    I 

RI  TE  ( 
GO  TO 
W  R I T  E  < 
GO  TO 
WRITE! 
GO  TO 
wRI TE( 
GO  TO 
WRITE ( 
GO  TO 


ESS 
1  ) 


K  DATA  FOP  REFERENCE 
KW,9  1) 
K  W ,  2  5  3 ) 

KW,  291  )N  U  3K,I  PB,  IB,! 

UK  ,  1  X  , «  B  EG  I N  B  LOC  K  ',14,'  WITH  ',14,'  PASS 
S   iLOCK  IS  SI4,1  OF  ',I<t,'  TO  /■'-     PROCESSED. 
K  ,92) 
KW  ,2  92  ) 

[1H  ,1X,»THE  FOLLOWING  IS  THE  PI  )G      LOCK  '  , 
AS  USED  IN  THE  SEA  TRIAL. ' ) 
K  .' ,  2  5  3  ) 
K  ,293)NBL0K 

(1H  , 52 X, 'BLOCK  ' , 15, '  DATA* ) 
KW,9  2) 
K  .  ,294) 

(1H     ,1X,»STATES    OR    DEGREES    OF     FREEDOM     I!      Tl    IS', 
K'   ) 
J  K  =  1 ,  K  S 

k) .e ;•.    >gc    ro  29s 

[296, 297,29  3,299,300,301) , JK 

KV/,3  .2)  XI  JK) 

29  5 

KW,303 )X( JK) 

2  95 

KW,304)X( JK) 

29  5 

KW, 3  >5)X{ JK) 

295 

KW,306)X(JK) 

29  5 
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301    WRITEIKW,3C7) 
29  5    CONTINUE 
302CF0RMAT(1H    ,1C 

1F12.7) 
3 ■    3    F  1 1 '      \  T  {  1  H     ,  ]  '• 

1F12.7) 
304OFORMATI1H     ,10 

1 F  1  2  .  7  ) 
3050FORMATUH    ,  K 

1 F 1 2  .  7  J 
3  FOR'    -\T  [1H     »1C 

1  F  1  2  .  7  ) 
3  '7    FO!      /I  (1H     ,1 
IF12.7J 
W  R 1 7  E  {  K\   ,  9  2  ) 
I  T  E  (  K  W , 

AT (In  ,1X 
0  0  3 1  9  J  K  = 1 , K 
IF(ME(JK).EQ. 
GO    TO     (31     r31 


X  (  J  K  ) 

X,«U  SORGE 

X,'V  SWAY 

X,'\  HEAVE 

X, "P  ROLL 

<,*:;  pitch 

>    |  '  Y  A  * 


, ' EFFECTORS 

MV 

0)GO    TO    3C9 

1,312,313,31 


X(  1  )  FT /SEC  W  T=72  M 

X(2)  FT/SEC  A,T  1  =  77  V  = 

X(3)  F7/SEC  AT  7=72 

XU)  RAD/SEC  *T  T=72  P  = 

X(5)  RAD/SEC  U  T=TZ  Q- 

X(6)  RAO/ SEC  \T  7=7  2 

USED    IN    THI S    SLOCK' J 
4,315,316,317,318)  , J  < 


?]        rfRlTECK 


w,  J 


19) 


3i    TO    3C9 

311  WRI7E(KW,320) 
GO    TO    3.0  9 

312  WRITE  IKW,321  ) 
GO    TO    3      ■ 

313  WRITE ( KV  , 3  22) 

TO    3C9 
3  14     JRI7E(KW,323) 
GO    TO    3     9 

315  WRI7E(KW,324) 
GO    TO    309 

316  .;  UTE  ( K ..   ,325) 
GO    TO    3 

317  WRI7ECKW.326) 
GO    TO    309 

3  IB    WRITE(KW,3  27) 
3    9    CONTINUE 
319    FORMAT (1H     ,10 
32C  MilH     ,10 

1'     DUE    TO    YVV 

321  FORMAT (1H     ,10 

322  FORi-  Al  [lri     ,1  . 
3230F0RMAT(1H     ,1C 

1*    U(14>    ZFWD, 

324CFORMAT11H    ,10 

l'ESS    AND    ME AS 

32  5    FORMAT  (  1H     ,  1 «' 

32  6    FOR  SAT ( 1H     ,1C 

3270F0RMAT(1H    ,1< 

1 'CALCULATED1 ) 

IF (ME (19) .EQ. 

WRI TE(KW,329J 


X  ,  •  S  E  C 
AND  Z -. 
X,  ' 

X, ' PRO 
< ,  •  T  H  R 
U<  15) 
X ,  •  N  0 1 
LIRE  IE  i 
X,  'CON 
X, 'CEN 
X, 'MO  I 


IKS    - 

'    i  \  I 
■.  '  ) 

QUO    - 
PEL  I  >' 
USTERS 

2.  A  F  T 
SE    -    G 
T    MO  IS 
STAN  r 
n  5  of 

SELESS 


5-0,  RCU  <Y,  I-  •  \i  El     U(l  )-'(  7)  '  ) 
A3    -     FORCES     \N  7S'  , 

U(3)-U (9 )     ANGL  :S     IN  IAOIANS"  ) 

-  U(10)     RPS     i     Ui 1 1 )  R PS/SEC*  J 

-  0(12)     YFWD,     0( 13)  YAF7,' , 
;+U=+Y,+M,-Z,-N    'J 

AUSSIAN     .'MITE  ADDITIVE     PROC»  , 

E'  ) 

It.  *MS  -  ADDED  rC  1        ESS'  ) 

BUOYANCY  ROT  ZERO' ) 

TRAJECTORIES  \Rl  M_SC  '  , 


D)GO  TO  3  23 
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3290 
1 
326 

331 
33: 


332< 

1 

333 

3  34 

33  5 
1 

33  6 

33  7 

338 


3400 

1 

3410 

1 

3420 

1 


343i 

345 
344, 


1 


346 
34  7 

34  8 


F  ORM  AT ( IH 
•G  Fk Q M  V 
IF(ME(2C ) 
WRITE (KW, 
FORMAT  (l.H 
W  R  I  T  F  (  K  hi  ■ 
W  R I T  E  ( K  W , 
FOI  -'  A T  {  1  i 
•),  Q-PRO 
WRITE  (KW, 
:AT{  IH 
W  R I  T  E  ( Kl  , 
v  1  {  1  I  1 
WRITE (K  i 
FORM  VI  []  H 
•USES  QNi 
W  R I T  E  (  K  i , 
FORMAT (IH 
WRITE (KW, 
FOI MATC1H 
WR I T E ( K  .  , 
W  R I T  E  i 
W  R I T  E  ( I  i 
FORMAT ( ] H 
IF(ME(l)  . 
W  R  I  T  E  (  I  •  , 
WRITE(KW, 
AT  (  IH 
•01 ,1- 
W  R I  T  E  ( I  • 
FOI  Mi  IH 
•  0U4-FWD 
W  R I TE ( K W , 
F  OR MAT ( IH 
•UOYANCY 
WRITE {KW, 
II  IATC1H 
'  TEN.TST 
WRITE (KW, 
W  VT  (  IH 
WRITE(KW, 
FOf  'AT (LH 
JV=1 
JR=  1 0 
DO  34  6  JT 
WRITE(KW, 
WRITE (KW, 
JV=JR+1 
JR=JR+10 
CONT INUE 
FORMAT!  lit 
FOR  M  AT ( 1 H 
WRITE  I KW, 


,  1 C  x  , 
E  H I C  L  E 
.  EO.  " i J 

331  ) 
iIOX, 

92) 

332  ) 
,1X,  « 

CESS, R 
3  33) ( J 

,  IX,  • 
3  34  )  (  J 

ilX,' 
3  35) 

,  1 X  ,  • 
RN , 
3  3  6) (J 

,1X,  « 
3  3  7  }  {  J 

,  1 X  ,  « 
92  ) 
253) 
3  33) 

,  1 X  ,  » 
EQ.C  )G 
319) 
34C  ) 

*  1  2  >; , 
ERV 
341) 

,12X, 
,  3- AM 
34  2) 

,  1 2  X , 
CONTRO 
3  43  ) 

,  1 2  X  , 

-  s  r .     i 

3  4  5) 
,15X, 

3  44  )  (J 


=  1,7 

3  47  KIT 


•ANGLES    ARE     INTEGRATED    P,Q,R    RESULTIN1, 

TRAJECTORY' ) 
GO    TO    33  3 

'VEHICLE    ANGUS    WILL     BE    PLOT!      >•  ) 


NOISE    GENERATION    PARAME1      IS,      .(•    >,R(6', 
-  1EASU <EMENT«  ) 
,Q(J),J=1,KS) 
0 ( J  > - '  ,6(2X,13,'=',F1 

,      (J  )  ,  J  =  1  ,  K  S  ) 

R  t  J  )  - '  , 6 (2X,I3,'=',F  1 


0      II  •  ) 

,'!  •;(  J)  ,  J=l  ,KS) 

QN(J) • ,6(2X,I3,'=« ,F1 

,  ■"■■!(  J)  ,J  =  1,KS) 

RN(J) • ,6(2X, 13, •=' ,F1 


!    IPUT    FUNCTICNS    USED 
Q    TO    3  39 


1    ,    RCURY    TANKS    -    U(  1) 
,2-STB»,3-P0RT  '  ) 


K  F  J  L     '  , 


3.41  ) 
3  . 4  )  ), 
(  6  )  ,       i  (  6  )  , 

3.4)  ) 

3.4)) 


IF.    THIS      I'  CK'  ) 


-U(  J  J     LIST 


CUWY    TANKS    -    J( 4)-W( 5)     TRIN     C0N1      • , 
•  ) 

•WATER    VH    TANKS-    U(6)-U(7)     TRIM    AND    B', 
L,6-FWD,7-AFT* ) 


'TANKS    STEP    FUNCTH 
TIME,UST  =  AMPL.ITU  I       1 

•NEGATIVE    T  SI        I       IS     J 

,  j  =  l ,  i  c ) 

■:w.  •  ,  3X  ,  •  LWC.      ' 


•UTS    -    AT 

N    L3F     LI      '! 


5T«  , 

)•  ) 


Q    STEP    G       •         I  ■      '  ) 
,1     (  '  S  T LP  • ,  I  3 ,  3 X  )  ) 


, JV, (TST( J)  ,J=JV,JP ) 
348 ) JT, JV  ,(UST< J ) ,J=JV,JI    I 


,1X,  ' 

,  1  x ,  • 

91  ) 


TST=,,I4,5X,I4,2X,10( 

UST=« ,  14,5 X,  14,2 X, 10( 
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1  X  ,  F  b  .  2  ,  1  X  )  ) 
1X,F3.2, IX) ) 


39 


3  50 


351C 

] 


•?. 


349 


3  53:; 

1 


355 


WRI 
WRI 
IF( 

W  R I 
WRI 
FOP 
JV  = 
JR  = 
JT  = 
W  R  I 
F  Q  R 
»T 
W  R I 
WR) 
I 

.  1  0  ( 
WRI 
WRI 
JV^ 
JR  = 
JT- 

a  r  i 

WRI 
W  R  I 
IF( 
WRI 
JV- 
JR  = 
JT  = 
I  R  I 
F  0  R 
«  TE 
WRI 
W  K  I 
WRI 
WRI 
JT= 
JV= 
JR  = 
W  R  I 
W  R I 
IF  < 
WR] 
WRI 
WRI 
W  R I 
WRI 
IF( 
WRI 
WRI 
JV= 
JR= 
W  R I 


TE(KW 
T  E  ( K  W 


,253) 

,338) 

MEC3I  .EG.  HGO    TO    349 
TE(KW,321 ) 
TE(KW,3  5    ) 

MATC1H     ,12X, 'SHROUD    ANGLES 
71 
BC 

a 

TE  (KW 

I  AT  (]. 
TEHtl 
TE  (KV 


-    8=D£LTA    P,9=DEI  1  ■'     Y'  ) 


T  E  ( 
I  AT  ( I 
'STEP 
TE< 
TE(KW 
Jc'  +  1 
JR+li 
JT+1 
T  E  (  K  \ 
T  E  { K  v 
T  E  ( K  l 
M  E  { 4 ) 
TE(KW 
r-  1 
] 

1 

TF  (KW 
AT  (L 
J,  1ST 
TE(  KW 
TE{K 
T  E  ( K  W 
TF( 
JT  +  1 
J  •  +  1 
JRH  1 
T  E  (  K  , 
TE( 

I  i) 
TF  (KW 
TF  (KW 
TE(KW 
TE(KW 
TECKW 

;  E  (  5 ) 

TE(KW 
Tr  (KW 
]  11 
120 
TE(KW 


,  3  r.  3  ) 

H  ,1?.X,  •SHROUD  STEP  FUNCTICN  INPUTS  -  AT 

ST=STAR1  TIMEtUST-A^PL.  [N  '  •  I   S') 

,345  J 

,3  52) ( J,  J  =  l,l  ) 

H  , 3X, 'INPUT  MO. '  ,  2X, « LUC.   ' , 

'-,  13,3X1  ) 

, 34  7) JT,JV  ,<TST(J) ,J=JV,JRJ 

, 348) JT , JV  ,(UST(J) , J=JV,JR ) 


,347)  JT, JV, ITS!  (J )  ,J=JV  ,JR  ) 

,  348  )  JT  ,  JV  ,  (  U  ST  (  J  )  ,  J-  J  V  ,  jr ) 

,92) 

.EQ.O)GO  TO  355 

,322) 


,35?) 

-I  ,12X,,PR0P  STEP  FUNCTION  INPUTS  -  AT  MOST 

=START  TIME,UST=AMPL.  IN  RPS  '      S/SEC) 

,345) 

,352)(J,J=1,3  ) 

,  3  4  7  )  J  7  ,  J  V  ,  (  T  S  T  (  J  )  ,  J=  J  V  ,  JR  ) 

,343) JT,JV, (UST( J) ,J=JV,JR) 


,34 

.  J  E 
,92 
,25 
,91 

,25 
,33 
.  EQ 
,92 
,32 


7) 

) 
n 

) 

3) 

) 

3) 

8) 

r 
.  I 

) 

3) 


Jl  , JV  ,(TST( J) ,J=JV,JR ) 

JT,  JV  ,  (US  I  (  J  )  ,  J-  JV  ,  JR  ) 
)GC  TO  ■.   ■ 


)G0  TO  3  54 


3  56) 


-536- 


35)60 

1 


35  7 
354 


3  6 


1 


FORMAT (1H    ,12 
•OST    TEN,TST= 
WRITE(KW,345) 
WRI  TF  (KV,  ,352) 
DH    35  7    JT=12, 
WRITE (KW, 347) 
WRITE(KW,348 ! 
JV=JR+1 
JR=JR+10 
C0NT1NUI 
WRI TF (KV , 
H    (    i L  (  1  9  ) 
W  R I  T  E  (  K  V  , 
GO    TG    360 
WRI-1  E(KW, 
!  (  1M 
•STEP    FUN 
IF (ME (2     ) 
WRI TE(KW, 
GO    TU    362 
WRI TE(KW, 
FORMAT ( 1H 
W  R I T  E  ( K  W  i 
WRITECKW , 
F1      MATdH 

•  TEN, 1ST 
WRITE  (I  , 
FORMAT! 1H 

•  -  U  ( 1  8 ) 
JV=151 

J  R  =  1 6  C 

WRITE (KW,345 ) 
WRITE (KW, 3  52) 
DO    369    JT=16, 
I T[( KW,347) 
WRITE (KW»348) 
JV=JR+1 
JR=JR-H 
369    CONTINUE 
W  R I  T  E  (  K     , 
WRITE(Ki   , 
FORMAT  (111 
•THE     EFFI 
JR=6 

DO    365    JV=1, 1 
3  66) 


X,«THRUSTER     STEP    FUNCTION    INPUTS 
START    TIME,UST=AMPL.     IN    RPS1) 

(J,J=1,1{   ) 

15 

JT , JV  ,(  I  ST< J)  ,  J=JV,  J     ) 

JT ,JV  ,(UST( J)  ,J=JV,J     ) 


-     AT     '   '  , 


JGO    TO     35  3 


X,  •  ANGLES    *RE    NOl     IT  I  ■      IT     '> 

;<     II   PUTS'  ) 
0)GO    TO    36  1 


i 


361 

3  63 
362 

3670 

1 

3650 

1 


92) 
.  EO. 
3  29) 

3  5  5) 

,1 
C  T  I  0 
.  EQ. 
3  31) 

3  63  ) 
,10X, 'VEHICLE     ANGLES- WILL    \CT    BE    PLOTTED') 

92) 
367) 

,12 
-ST  A 
368) 

,15 
•  ) 


X, 'ANGLE    STEP    FUNCTION     INPUTS    -    AT     MOST', 
RT    TI ^E,UST=AMPL .     IN    R \ D) VMS' ) 

X,»VEHICLE  ..3    PHI ,THETA,PSI    =    U(16)», 


(  J,  J---1,  ]  0) 

18 

JT  ,  JV,  (1  ST (J)  ,J=JV,JR) 

JT  , JV, (UST(J  )  ,J=JV,JR ) 


3640 

1 


92  J 

3  64) 
,12 

C  TO  R 


3  66 


36  5 


37L 


WRITE(KW, 
FORMAT (1H 
JR=JR+6 
CONTINUE 
WRITEIKW, 
WRITE(KW, 
FORMAT  (  1H 
WRITE (KW, 


X,'U(J)    -    STARTING    VALUES    F      -     M.  I      )F     ', 
STE  P    FUNC  1  I  CNS1  ) 

3,6 

(J,U( J) ,J=JV,JR) 

,»UU)-»,6(2X,I3,»  =  »,F13.4)) 


92) 
3  7  j  ) 

,1X,'END  OF  INPUT  FUNCTIONS  THIS  BLOCK1) 
253) 

-537- 


WRITE  (KV) 
WRIT.EIKW 
WRITE (KW 
IF( IOUT( 
3710FORMAT(l 
l'A  TRIAL 
WRITE (KW 

372  FORMAT  (II 
WRITE (KW 
WR1 TE( KW 
WRITE (KW 
W  R I  T  E  (  K  W 

[TE(KW 

374  FORMAT (1 

I TE (KW 

373  FORMAT  (1 
W  R I  T  E  (  K  W 
WRITE (KW 
WRITE (KW 
WRI TEIKW 

I  T  E  (  K  W 

37  5  FORMAT (1 

WRITE (KW 

376  FORMATU 

WRI TE(KW 

WRITE ( y. 

w  r  i  t  z:  ( 

.-i  R I T  E  ( 
WRITE  (K;; 
JV=KX+1 
W  R I T  E  (  K  W 

I  T  E  ( K  W 
WRITE (KV 
W  R  I  T  E  (  K  v 
WRITE  (  KV; 
W  R I T  E  ( K  W 
37  7  FCf MAI  (1 

ITE(KW 
378  FORMAT (1 

I TE (KW 
W  R I  T  E  ( K  W 
WRITE  I KW 
4RI1 E(KW 
W  R I  T  E  ( K  W 
WRITE(KW 
WRI TE(KW 
WRITE (KW 
WR] TE(KW 
WRITE (KW 
WRITE (KW 
331  FORMATU 
JV=1 
DO    382    J 


•0)GO  TO  404 

,'X(J)  -  TOTAL  STATE  VECTOR  USEU  FOR  SE», 

RAT  ION'  ) 

(J,X( J) ,J=1,KX) 

,  '  X  (  J  )  -  •  ,  6  (  2  X  ,  I  3  ,  ■  =  ■  ,  F  1  3 .  4  )  ) 


, ' XH( J )-    START  ING    STATE    VEC  '  I 

(  J,  XI    (  J)  9J-1  ,KX) 
,,XH(J)«,6(2X,I3f,=',F12.4)) 


, ' P( J)    -    TOTAL    E '  El ER    VECTOR" ) 

(  J  f  P  (  J )  f  J  =  1 ,  K  X ) 
,«PU)-,,6(2X,I3.,  =  ,,FL3.4)) 


91  ) 

2  5  3  I 

3  71  ) 
)  .EQ 

.IX 

;en* 

372) 
.IX 
9  2  ) 
2  53) 
91  ) 

2  53  ) 

3  74  ) 
,  1  x 

3  7  3  ) 
.IX 
02) 
2  5  3) 
91  ) 

2  53  ) 
375  ) 

,1X 

3  76) 
,1X 

02) 
2  53) 
U) 
253  ) 
375) 


376)  (Jt  P(J)  j  J=JV,Ki\F) 
92) 

2  53) 
91  ) 
2^3) 
37  7) 
H     ,1X 

3  7  e ) 

,1X 
9  2) 

253) 
91  ) 

2  53) 
377) 

3  73) (J,PH( J) ,J=JV,KNP) 
92) 

253) 
91) 
253) 
381  ) 
i     ,1X,»EH(J)     -    DIAGONAL    OF    ERROR    COV.    MATE  IX') 


,  »PH(  J)-    STAR!  ING    PAI    .  -1E1  ER    VEL  FOR  •  ) 
( J, PH( J) , J=1,KX) 
l'PH(J)',6(2X,I3.,=,,F13.4)) 


-1  ,KEH 


-538- 


c 
c 

c 

c 
c 


333 
332 

404 

3  79 
330 


WR 

J  = 

JV 

co 

.>'  R 
W  R 
WR 
WR 

FO 
.,  R 
F  0 


IT 

-J 

NT 

n 

IT 
I  T 
I  T 
IT 

IT 

1  T 
I  T 


(K 

T( 

V 

+  1 

NU 

(K 

(K 

(K 

(K 

(K 

T{ 

(K 

T  ( 

(K 

(K 

*  ■:■■ 

OC 


W,383)J,EH(JJ 

1H    ,  IX,  • h:K J)-f  ,5X, 15, 5X,F20,  12) 


c 

W  ,  9 
W  ,  ? 

W ,  2 
W  ,  3 
1H 
I  ,  i 
lri 
rf ,  9 
■  ?  ? 


2) 

53) 

1  ) 

53) 

79) 

flX 

8  C  ) 

.IX 

Z) 

53) 


,  '  I  HUT-     OUTPUT    D 
(J, I  OUT (J), J =1,1 

, • i ou r ( j ) • , i o ( 2x 


L:S  [GNAT 

) 
t  12,  •  =  • 


ION 
1 14 


V  I  C  T 
)  ) 


'  : ;  9*    '>  -;  ;';  ; ';  r^    '- 


END    OF     BLOCK    DATA    OUTPUT 


** 


J,  J*  ou  -t,  J* 


,    .'.   -■     ,1,   ^p,  „■,   .  -  -*•,  »L*  .An    .',  ,v  ,u  .»*» 

'.-  V  *■»-  -v  '*-  '»x  *r  -i*-  -v  *»■  ir  *r  *r>  -,*■  i* 


RUN    A    SIMULATED    SEA    TRIAL     FOP     THIS    BLOCK 

WRI TE  ( K - , 3 84 ) ( X{ J) , J=l , KS  ) 
3840FORMATI1H     ,1X, 'BEGIN    SEA    TRIAL-    XU)  =    ', 
16(2X,F13.6,2X) ) 
CALL     SEATR(IABOtP,X,XN) 

TEST    FOR    A    VALID    SEA    TRIAL;  IF   NO!      ,  ABORT    THIS    BLOCK 
IF(  IABO.EO. I  ONE )GO    TO    1  34 
IF [MREF.NE .1 ) GO    TO     133 
0  0    185    IP=1,;MP3 

186  RE  AD  (  KR ,  1 5  )  ( I    !RT  (  J  )  ,  J  =  1  ,  0  A  R  J  ) 
DO    187    J=l  ,NM  tt 

IF(  1    IRF(J)  ,NE.  IMRT{ J) )GC    TO     186 

187  COOT  I  I'm UE 
185  CONTINUE 

188  WRITECKWf 135)  JBLOK 

135  FORMAT (5X, 'BLOCK  NUMBER'  , I  5 t5X , « SEA  TRIAL  ABORT') 
GO  TO  1 


L-  -J-   ,».    <JL»  »'*     .».  -t.    .  ,  si,  *A,   .'.    ,i.   .'^   J,  .  .   »U  -'-  ^O  •*'      .'^  *l« 


-'-   ,*,    .'. 


PLOT    THE    OAT  A    GENERATED    BY    TOE    SEA    TIMAL 
L34    NPLOT=NBLI 

OCT 

CALL  STOUTCTfUDfZfZNf I0UT(2),N  r,N?LCT) 


TURN  OFF  THE  NOISE  GENERATOR  IN  THE  OCEAN  VEHICLE 

IF (ME (6) .NE.OJGO  TO  178 

J  f=NDT*K3 

00  180  JK=1,JW 

ZNUK)=Z(JK) 
180    CONTINUE 

GO    TO    179 
178    ME(6)=0 
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t  if*  -V  nr  -v  -i* 


BEGIN  IDENTIFICATION  PASSES  OVER  SEA  TRIAL  DATA 
179  00  11  IP=1,NPB 

READ(KR,40 )KF,KP 

IFtMREF.EQ.DGO.  TO    137 


,  .-,  .•-  -.  .•. 


EXTENDED  KALMAN 
GO  TO  11 


FILTER  PASS  OVER  DATA 


*|-  1-  T  -i-  'i* 


.  .<,  ,'.   '-  .t-  -.'■ 


EFI   ENCE  PASS  OVER  OAT  A  WITH  TWO  COEFFICIENTS 

PAR  ^  !E1  ERS  VAR  I  ED 

EAD  MODEL  REFERENCE  C  IA  JES  f.  S R L  C C T  f 
VARIABLES  LF,LP,RN 
137  READ t KR, 40 ) { I BLT ( J ) , J3LT { J ) , J= 1 ,  II ND ) 
DO  141  J=1,NIND 
KA=I BLT< J) 

IF{KA.LE.O)GO  TO  142 
LF(KA)=J3LT(J) 

141  CONTINUE 
GO  TO  137 

142  READ(KR ,4C  ) (  I3LT1 J) , J3LT( J)  ,J=1 ,NI  MO ) 
DO  143  J=1,NIND 

KA=IBLT( J) 

IFIKA.LE.OGO    TO    167 
LP(KA)=J  -LT(J  ) 

143  CONTINUE 
GO  TO  L42 

1  67  R  EAD ( KR , 39 ) ( I 3L  T { J ) , A8LT (J )  ,  J=  I  ,  I  I 

DO  loo  J  =  l  ,NIN 

KA=IBLT( J) 

IFCKA.LE.O )G0  TO  144 

RN(KA)=ABLT< J) 
16£  C(  1 INUE 

GO  TO  167 
]>/,  dq  169  JTS=1,KB 

K=LC JTS) 

IF  (•-.  J(K)  ,EQ.  OCR  TO  1  S6 
169  CONTINUE 


TEST  FOR  PASS  CARD  AND  CORRECT  PASS  DATA 
ISW=1 
READ(KR, 
DO  145  J 
IF(  IR,RF( 

145  CONTINUE 
GO  TO  ( I 

146  WRITE (KW 
148 ;F CROAT (1 

1»  DATA  E! 


15  )  (  IMRT ( J)  , J=l ,NMRT) 

=  1  ,NMRT 

J)  .NE.  IMRT (J )  )GU  TO  146 

47,-11  )  r  ISW 

,148) ( IMRTCJ)  rJ  =  l  »NMRT I, IB, 
X,4A1  ,5X,  ' BLOCK  NUMBER 
!RROR  ,PASS  NUMBER   • ,14) 


HAS  INPUT1, 


-5^0- 


197 


196 
L95 


IF( 

00 

R  E  A 

DO 

IF( 

COO 

IF( 

GO 

CON 

I  8  = 

I  s\ 

ISW 

GO 


NP 
19 

D( 
1  9 
IN 
TI 
NP 
TO 
1  1 
IB 
=  2 

TO 


B.LE.DGO  TO  195 

6  JPT=1 ,6 

KR,  15  )(  IMRT  I  J) ,J  =  1  ,NMRT) 

7  J=1,NMRT 

RF(  J)  .NE.  IMR1  (J )  )GO  TG  196 

NUE 

B.GT.2JGO  TO  11 

10 
rjUE 
+  1 


88 


C 

C  #*** 

C  SET 
C  COEF 
C  VAF;  I 
147 


THE  INOICES, INITIAL  VALUES,  AND  INC 
FICIENTS  AND  PARAMETERS  (TOTAL  OF  T 
ED  IN  MODEL  REFERENCE  P'VSS 


^JC) 


ro  b 


OF 

E 


IF(KF.GT.l )G0  TO  136 

IF(KF.GT  .0 )G0  TO  L39 

ICDV=LP(1) 

ICNV=LP(  I) 

NI  =  2 

GO  TO  ] 4  ) 
139  ICDV=LF(  D+KS 

ICNV=LP< 1 ) 

NI=1 

GO  TO  14 
13,-.  ICDV  =  LF(1)+KS 

ICNV=LF{ 2J+KS 

NI=0 
1-',   EF(N1  .EQ.  )  GO  TO  15  3 

IF(NI  .  EQ.l  !GC  TO  154 

CD(1  )=Pi\i  ICDV) 

CNU)=PH<  ICNV) 

CDSV=P  (  ICDV) 

CNSV=P( ICNV J 

P( ICDVJ=CO( 1 ) 

P{  ICNV)=CN( 1 ) 

DELCD=PINC( ICDV ) 

DELCN=PI MC  (  ICNV) 

'3  0  15  5  K=l,  I  CD 

C  )(  K  +  l  )=CD(K)+DELCD 
15  5  CON! I NUE 

DO  156  K=lfICN 

CN(K+1 )=CN<K) +DELCN 
156  CONTINUE 

GO  TO  157 
154  CM  1  )  =  XH(  ICDV)   ' 

CM(1 )-PH( ICNV) 

CDSV=X [ICDV) 

CNSV=PUCNV) 

XI  ICDV)=CD<1 ) 


-5M- 


15 

15' 
15 


3 


16' 


16 

C  ** 

C  DE 

15 

38 


3H 


1 


P<  IC 
DELC 
DELC 

DO  1 
C  n  (  k 
CGNT 
DO  1 
CN(K 
CO  NT 
GO  T 
COtl 
CNC1 
CDS  , 
C  N  S  V 

X  (  [  C 

XI  IC 
DEI  ! 
DELC 
DO  1 
C  D  (  K 
CON! 
DC  1 
C  N  (  K 
C  3NT 


33 


38 
39 


38 

39 


3  9 
40 


4  J 
40 


SCR  II 
7    W  R 1  T 

5  FORM 
IF(,N 
IF(N 
I  RIT 

dJt 
116) 
[RIT 
F 
1'RUN 
2  F  1 3 . 
GO    T 
7    WRI  r 
LC  FORM 
I'll    • 
WRIT 
GO    T 

6  WRI  T 
20 FORM 

116) 
WRI  T 
W  R  1  T 
FORM 
WRIT 
WRIT 
FORM 
F  0  R  •' 


NV)=CN 
D=XINC 
N=PINC 
5  8  K  =  l 
+ 1 }  =  C  D 
INUE 

59  K=l 
+  1  )  =  CN 
IN1  OF 

0  157 

)  =  XI,(  1 
)=XHU 
=  X(  I  CD 
=  Xl  ICN 
D  V  ) 

D=XI NC 
N=XINC 

60  K=l 
-t-1  )=CD 
INUE 

61  K=l 
+1)=CN 

1  N  U  E 

COEFF 
E (KW,3 

A  T  (  1 
I  .GT  -  1 
I .GT  .0 
E(KW,3 

AT  (Hi 

E ( KV  ,3 
AT  (1H 

IN    IN 
4 ,  » i 
0    39 1 
E { K .   ,3 
AT  (  1H 
EXES     ' 
E ( K !   ,3 
0    3 

E(KW,3 
A  T  ( 1 H 

E  ( K  W  »  3 

E  (  K .-  , '+ 
AT  UH 
E  (  K  W  ,  (t 
E (KW,4 
ATdM 
AT  (  1H 


(1  ) 

(  ICDV) 

(  ICNV) 

,  I  CD 

{ K) +DELC0 

»  I  CM 

(K) +DELCN 


CJV) 
CNV) 

V) 
V) 

(1 ) 
( 1 ) 

{  ICDV) 
(  ICNV) 
,  I C  D 
(K)+DELCD 

,  I  CN 
UO+DELCN 


%l»    O*    -',     -J,       -    -     »'- 


•j.  ->,  o;  a*  JL  u*  >■-  ~*;  .'*  J*  .'-  j;  j1.  y-  o-   .<-  y -  .<-  ^--  ;'.  ju  -'-  ; 

I C  I  EN T  S    A  M I )    PAPA  M E  T  E R S    B E I N G    V  A 
85) 

,1X , ' COEFF IC IENTS    A JD     V  rER 

)GO    TO     3  36 
■      ■    TO    3  37 
88) ICDV, ICNV 
flX,«TV!0    COEFFICIENTS    -    INDEXES 


R I  E  D 

SI' 

14, • AND' , 


C9)C0( 1 ) ,CN( 1 ) , DELCO,OELCN,C JSV 
flX,« START  AT  ■ ,F13.4, • AND»,F1 
CREMENTS  OF  » ,F 13. 4f • AND • , F13.4 
', F13.4) 


91)1  C  D  V ,  I C  N  •/ 

,  1X,'Q\E    COEFFICIENT     AND 


,CMSV 
3.4, 3X 

,  3  X  ,  •  «■• 


S  A  V  b  •  , 


N  E    -1  A 
39)CO(l) t CN( 1 ) ,DELCD,0     i_C\,C  )SV 


T  /, 


'  » 


A  N D '  ,  16) 


92 ) ICDV, ICNV 

,  IX,  'TWO    PARAMETERS 


I  NO! 


89)CD(1  )  ,CN<  1  )  ,  DELCD,DELCN 

)  1 )  (  J  f  R  N  (  J )  t  J  =  1 1 K  S ) 

,  "WE IGHT ING  MATRIX  DIAG.  '  , 

02)(J,LF(JJ,J=ltlO) 

03MJ,LP(J)»J  =  1>10) 

,  ■  J  ,  L  P  (  J  )  '  i  i  0  (  1  X  ,  I  2  ,  2  X  ,  I  3  ) 

,  •  J  ,  L  F  (  J  )  »  ,  1  0  (  1  X  ,  1  2  ,  2  X  ,  I  3  ) 


XES  ' 
,CQSV 

6  (  2  X  , 

) 
) 


1 1 4-  ,  « 

,  Cf;sv 
1 1 , 2  x  , 


•'  o», 


F11.4) J 


*»,  V  •''  *'-  -*»   "''  -** 
-I-  -1.-  *p  '•-  *.'■  *f"  -<' 

GENf 

00 

IF( 

X(  i 

GO 

P(  I 

DC) 

CAL 

IF< 

WRI 

F  0  R 
i 


',-  -.»  V  -r  -.'  '.'  -t»  V  -r  V  *?  -v  V  V  V  -r  'c  *?   V  *.'  V  -.'  V 


162 
163 


1631 
1 


CALC 
164 


15? 
151 


GO 


U-LA 
NC= 

COS 

DO 

00 

K=L 

KZ= 

XDI 

XDI 

COS 

IF( 

C  '  : 

CO"! 


E    T 

149 
NI  . 

cov 

TO 

cov 

150 

L    M 
IAB 

TE( 
MAT 

PAS 
TO 


HE 

J  = 
EC. 
)=C 
163 
)=C 

1  = 
ORE 
O.E 
KW, 
(7X 
S  • 
] 


MODEL    DATA    USING    SE 
1  ,NCN 

2)  GO    TO     16  2 
D  ( 1  ) 

D  (  1  ) 

1,MCD 

FUABOtPfX) 

O.I  ONE) GO    TO     164 
165JNBL0K, I J 

,  'BLOCK    IMU  i   '  ,  I  5, 


A  ;''  V:  :V  -''  ;"  - 

A    TRIAL     INPUTS 
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SECTION  9 


BIBLIOGRAPHY  AND  BIOGRAPHY  (B) 
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B2   BIOGRAPHICAL  NOTE 
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CHAPTER  B2 
BIOGRAPHICAL  NOTE 

Lt,  Michael  N.  Hayes  was  "born  in  Abilene,  Texas,  on  September  2, 
19^-1  •  Four  years  later  the  family  moved  to  Ohio,  where  he  attended 
primary  schools  in  Wakeman  and  in  Massillon,  He  was  graduated  from 
Washington  High  School,  Massillon,  Ohio,  in  June  1959. 

Mr.  Hayes  enlisted  as  a  Seaman  Recruit  in  the  United  States  Navy 
in  September,  1959 «   He  was  graduated  from  the  U.S.  Naval  Guided 
Missiles  School,  Dam  Neck,  Virginia,  in  July,  19^0,  and  was  assigned 
to  the  U.S.S.  Kitty  Hawk  (CVA-63)  until  June,  1961.   He  was  graduated 
from  the  U.S.  Naval  Preparatory  School,  Bainbridge,  Maryland,  in 
August,  196l. 

In  September,  19&1,  Mr.  Hayes  began  4  years  of  undergraduate 
education  at  North  Carolina  State  University,  Raleigh,  N.C.,  under 
the  auspices  of  the  Naval  Enlisted  Scientific  Education  Program 
(NESEP).  He  was  graduated  in  June,  19&5?  with  the  degrees  of 
Bachelor  of  Science  in  both  Electrical  Engineering  and  Applied 
Mathematics  and  with  the  degree  of  Master  of  Electrical  Engineering. 

After  attending  the  U.S.  Naval  Officer  Candidate  School  at 
Newport,  R.I.,  Mr.  Hayes  was  commissioned  an  Ensign  in  the  U.S.  Navy 
in  October.  19&5:  and  assigned  for  duty  at  the  Boston  Naval  Shipyard, 
as  a  Ship  Superintendent,  supervising  naval  ship  construction  and 
repair,  and  attended  evening  classes  at  Boston  University  in  business 
administration  and  at  Northeastern  University  in  pure  mathematics. 
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In  June,  1967 ,   Mr.  Hayes  entered  M.I.T.  as  a  U.S.  Naval  Post- 
graduate student  in  Curriculum  13A  with  specialized  studies  in  elec- 
trical engineering.   After  completing  coursework  and  a  thesis  entitled 
"Dynamic  Models  of  Binary  Plate  Distillation  Columns,"  he  was  awarded 
the  degrees  of  Master  of  Science  in  Electrical  Engineering  and 
Electrical  Engineer  in  September,  19&9*   He  is  a  member  of  Sigma  Xi, 
Tau  Beta  Pi,  Eta  Kappa  Nu,  Phi  Eta  Sigma,  and  is  an  Eagle  Scout. 

Lt.  Hayes  is  married  to  the  former  Ann  Marie  Graney  of  Stoughton, 
Massachusetts.   They  have  a  three-year-old  son,  Stephen,  and  a  one- 
year-old  son,  Kevin.  Lt.  Hayes  is  the  son  of  Mr,  and  Mrs.  Ross  N, 
Hayes  of  Massillon,  Ohio.  .He  has  a  brother,  James,  and  sisters,  Ellen 
and  Roxy. 
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